2 * bt856 - BT856A Digital Video Encoder (Rockwell Part)
4 * Copyright (C) 1999 Mike Bernson <mike@mlb.org>
5 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
7 * Modifications for LML33/DC10plus unified driver
8 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
10 * This code was modify/ported from the saa7111 driver written
13 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
14 * - moved over to linux>=2.4.x i2c protocol (9/9/2002)
16 * This program is free software; you can redistribute it and/or modify
17 * it under the terms of the GNU General Public License as published by
18 * the Free Software Foundation; either version 2 of the License, or
19 * (at your option) any later version.
21 * This program is distributed in the hope that it will be useful,
22 * but WITHOUT ANY WARRANTY; without even the implied warranty of
23 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
24 * GNU General Public License for more details.
26 * You should have received a copy of the GNU General Public License
27 * along with this program; if not, write to the Free Software
28 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
31 #include <linux/module.h>
32 #include <linux/types.h>
33 #include <linux/slab.h>
34 #include <linux/ioctl.h>
35 #include <asm/uaccess.h>
36 #include <linux/i2c.h>
37 #include <linux/i2c-id.h>
38 #include <linux/videodev2.h>
39 #include <media/v4l2-device.h>
40 #include <media/v4l2-chip-ident.h>
41 #include <media/v4l2-i2c-drv.h>
43 MODULE_DESCRIPTION("Brooktree-856A video encoder driver");
44 MODULE_AUTHOR("Mike Bernson & Dave Perks");
45 MODULE_LICENSE("GPL");
48 module_param(debug
, int, 0);
49 MODULE_PARM_DESC(debug
, "Debug level (0-1)");
52 /* ----------------------------------------------------------------------- */
54 #define BT856_REG_OFFSET 0xDA
55 #define BT856_NR_REG 6
58 struct v4l2_subdev sd
;
59 unsigned char reg
[BT856_NR_REG
];
64 static inline struct bt856
*to_bt856(struct v4l2_subdev
*sd
)
66 return container_of(sd
, struct bt856
, sd
);
69 /* ----------------------------------------------------------------------- */
71 static inline int bt856_write(struct bt856
*encoder
, u8 reg
, u8 value
)
73 struct i2c_client
*client
= v4l2_get_subdevdata(&encoder
->sd
);
75 encoder
->reg
[reg
- BT856_REG_OFFSET
] = value
;
76 return i2c_smbus_write_byte_data(client
, reg
, value
);
79 static inline int bt856_setbit(struct bt856
*encoder
, u8 reg
, u8 bit
, u8 value
)
81 return bt856_write(encoder
, reg
,
82 (encoder
->reg
[reg
- BT856_REG_OFFSET
] & ~(1 << bit
)) |
83 (value
? (1 << bit
) : 0));
86 static void bt856_dump(struct bt856
*encoder
)
90 v4l2_info(&encoder
->sd
, "register dump:\n");
91 for (i
= 0; i
< BT856_NR_REG
; i
+= 2)
92 printk(KERN_CONT
" %02x", encoder
->reg
[i
]);
93 printk(KERN_CONT
"\n");
96 /* ----------------------------------------------------------------------- */
98 static int bt856_init(struct v4l2_subdev
*sd
, u32 arg
)
100 struct bt856
*encoder
= to_bt856(sd
);
102 /* This is just for testing!!! */
103 v4l2_dbg(1, debug
, sd
, "init\n");
104 bt856_write(encoder
, 0xdc, 0x18);
105 bt856_write(encoder
, 0xda, 0);
106 bt856_write(encoder
, 0xde, 0);
108 bt856_setbit(encoder
, 0xdc, 3, 1);
109 /*bt856_setbit(encoder, 0xdc, 6, 0);*/
110 bt856_setbit(encoder
, 0xdc, 4, 1);
112 if (encoder
->norm
& V4L2_STD_NTSC
)
113 bt856_setbit(encoder
, 0xdc, 2, 0);
115 bt856_setbit(encoder
, 0xdc, 2, 1);
117 bt856_setbit(encoder
, 0xdc, 1, 1);
118 bt856_setbit(encoder
, 0xde, 4, 0);
119 bt856_setbit(encoder
, 0xde, 3, 1);
125 static int bt856_s_std_output(struct v4l2_subdev
*sd
, v4l2_std_id std
)
127 struct bt856
*encoder
= to_bt856(sd
);
129 v4l2_dbg(1, debug
, sd
, "set norm %llx\n", (unsigned long long)std
);
131 if (std
& V4L2_STD_NTSC
) {
132 bt856_setbit(encoder
, 0xdc, 2, 0);
133 } else if (std
& V4L2_STD_PAL
) {
134 bt856_setbit(encoder
, 0xdc, 2, 1);
135 bt856_setbit(encoder
, 0xda, 0, 0);
136 /*bt856_setbit(encoder, 0xda, 0, 1);*/
146 static int bt856_s_routing(struct v4l2_subdev
*sd
,
147 u32 input
, u32 output
, u32 config
)
149 struct bt856
*encoder
= to_bt856(sd
);
151 v4l2_dbg(1, debug
, sd
, "set input %d\n", input
);
153 /* We only have video bus.
154 * input= 0: input is from bt819
155 * input= 1: input is from ZR36060 */
158 bt856_setbit(encoder
, 0xde, 4, 0);
159 bt856_setbit(encoder
, 0xde, 3, 1);
160 bt856_setbit(encoder
, 0xdc, 3, 1);
161 bt856_setbit(encoder
, 0xdc, 6, 0);
164 bt856_setbit(encoder
, 0xde, 4, 0);
165 bt856_setbit(encoder
, 0xde, 3, 1);
166 bt856_setbit(encoder
, 0xdc, 3, 1);
167 bt856_setbit(encoder
, 0xdc, 6, 1);
169 case 2: /* Color bar */
170 bt856_setbit(encoder
, 0xdc, 3, 0);
171 bt856_setbit(encoder
, 0xde, 4, 1);
182 static int bt856_g_chip_ident(struct v4l2_subdev
*sd
, struct v4l2_dbg_chip_ident
*chip
)
184 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
186 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_BT856
, 0);
189 /* ----------------------------------------------------------------------- */
191 static const struct v4l2_subdev_core_ops bt856_core_ops
= {
192 .g_chip_ident
= bt856_g_chip_ident
,
196 static const struct v4l2_subdev_video_ops bt856_video_ops
= {
197 .s_std_output
= bt856_s_std_output
,
198 .s_routing
= bt856_s_routing
,
201 static const struct v4l2_subdev_ops bt856_ops
= {
202 .core
= &bt856_core_ops
,
203 .video
= &bt856_video_ops
,
206 /* ----------------------------------------------------------------------- */
208 static int bt856_probe(struct i2c_client
*client
,
209 const struct i2c_device_id
*id
)
211 struct bt856
*encoder
;
212 struct v4l2_subdev
*sd
;
214 /* Check if the adapter supports the needed features */
215 if (!i2c_check_functionality(client
->adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
218 v4l_info(client
, "chip found @ 0x%x (%s)\n",
219 client
->addr
<< 1, client
->adapter
->name
);
221 encoder
= kzalloc(sizeof(struct bt856
), GFP_KERNEL
);
225 v4l2_i2c_subdev_init(sd
, client
, &bt856_ops
);
226 encoder
->norm
= V4L2_STD_NTSC
;
228 bt856_write(encoder
, 0xdc, 0x18);
229 bt856_write(encoder
, 0xda, 0);
230 bt856_write(encoder
, 0xde, 0);
232 bt856_setbit(encoder
, 0xdc, 3, 1);
233 /*bt856_setbit(encoder, 0xdc, 6, 0);*/
234 bt856_setbit(encoder
, 0xdc, 4, 1);
236 if (encoder
->norm
& V4L2_STD_NTSC
)
237 bt856_setbit(encoder
, 0xdc, 2, 0);
239 bt856_setbit(encoder
, 0xdc, 2, 1);
241 bt856_setbit(encoder
, 0xdc, 1, 1);
242 bt856_setbit(encoder
, 0xde, 4, 0);
243 bt856_setbit(encoder
, 0xde, 3, 1);
250 static int bt856_remove(struct i2c_client
*client
)
252 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
254 v4l2_device_unregister_subdev(sd
);
259 static const struct i2c_device_id bt856_id
[] = {
263 MODULE_DEVICE_TABLE(i2c
, bt856_id
);
265 static struct v4l2_i2c_driver_data v4l2_i2c_data
= {
267 .probe
= bt856_probe
,
268 .remove
= bt856_remove
,
269 .id_table
= bt856_id
,