1 /* 2 * bt819 - BT819A VideoStream Decoder (Rockwell Part) 3 * 4 * Copyright (C) 1999 Mike Bernson <mike@mlb.org> 5 * Copyright (C) 1998 Dave Perks <dperks@ibm.net> 6 * 7 * Modifications for LML33/DC10plus unified driver 8 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx> 9 * 10 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net> 11 * - moved over to linux>=2.4.x i2c protocol (9/9/2002) 12 * 13 * This code was modify/ported from the saa7111 driver written 14 * by Dave Perks. 15 * 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. 20 * 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. 25 * 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. 29 */ 30 31 #include <linux/module.h> 32 #include <linux/types.h> 33 #include <linux/ioctl.h> 34 #include <linux/delay.h> 35 #include <linux/i2c.h> 36 #include <linux/videodev2.h> 37 #include <linux/slab.h> 38 #include <media/v4l2-device.h> 39 #include <media/v4l2-ctrls.h> 40 #include <media/bt819.h> 41 42 MODULE_DESCRIPTION("Brooktree-819 video decoder driver"); 43 MODULE_AUTHOR("Mike Bernson & Dave Perks"); 44 MODULE_LICENSE("GPL"); 45 46 static int debug; 47 module_param(debug, int, 0); 48 MODULE_PARM_DESC(debug, "Debug level (0-1)"); 49 50 51 /* ----------------------------------------------------------------------- */ 52 53 struct bt819 { 54 struct v4l2_subdev sd; 55 struct v4l2_ctrl_handler hdl; 56 unsigned char reg[32]; 57 58 v4l2_std_id norm; 59 int input; 60 int enable; 61 }; 62 63 static inline struct bt819 *to_bt819(struct v4l2_subdev *sd) 64 { 65 return container_of(sd, struct bt819, sd); 66 } 67 68 static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl) 69 { 70 return &container_of(ctrl->handler, struct bt819, hdl)->sd; 71 } 72 73 struct timing { 74 int hactive; 75 int hdelay; 76 int vactive; 77 int vdelay; 78 int hscale; 79 int vscale; 80 }; 81 82 /* for values, see the bt819 datasheet */ 83 static struct timing timing_data[] = { 84 {864 - 24, 20, 625 - 2, 1, 0x0504, 0x0000}, 85 {858 - 24, 20, 525 - 2, 1, 0x00f8, 0x0000}, 86 }; 87 88 /* ----------------------------------------------------------------------- */ 89 90 static inline int bt819_write(struct bt819 *decoder, u8 reg, u8 value) 91 { 92 struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd); 93 94 decoder->reg[reg] = value; 95 return i2c_smbus_write_byte_data(client, reg, value); 96 } 97 98 static inline int bt819_setbit(struct bt819 *decoder, u8 reg, u8 bit, u8 value) 99 { 100 return bt819_write(decoder, reg, 101 (decoder->reg[reg] & ~(1 << bit)) | (value ? (1 << bit) : 0)); 102 } 103 104 static int bt819_write_block(struct bt819 *decoder, const u8 *data, unsigned int len) 105 { 106 struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd); 107 int ret = -1; 108 u8 reg; 109 110 /* the bt819 has an autoincrement function, use it if 111 * the adapter understands raw I2C */ 112 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { 113 /* do raw I2C, not smbus compatible */ 114 u8 block_data[32]; 115 int block_len; 116 117 while (len >= 2) { 118 block_len = 0; 119 block_data[block_len++] = reg = data[0]; 120 do { 121 block_data[block_len++] = 122 decoder->reg[reg++] = data[1]; 123 len -= 2; 124 data += 2; 125 } while (len >= 2 && data[0] == reg && block_len < 32); 126 ret = i2c_master_send(client, block_data, block_len); 127 if (ret < 0) 128 break; 129 } 130 } else { 131 /* do some slow I2C emulation kind of thing */ 132 while (len >= 2) { 133 reg = *data++; 134 ret = bt819_write(decoder, reg, *data++); 135 if (ret < 0) 136 break; 137 len -= 2; 138 } 139 } 140 141 return ret; 142 } 143 144 static inline int bt819_read(struct bt819 *decoder, u8 reg) 145 { 146 struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd); 147 148 return i2c_smbus_read_byte_data(client, reg); 149 } 150 151 static int bt819_init(struct v4l2_subdev *sd) 152 { 153 static unsigned char init[] = { 154 /*0x1f, 0x00,*/ /* Reset */ 155 0x01, 0x59, /* 0x01 input format */ 156 0x02, 0x00, /* 0x02 temporal decimation */ 157 0x03, 0x12, /* 0x03 Cropping msb */ 158 0x04, 0x16, /* 0x04 Vertical Delay, lsb */ 159 0x05, 0xe0, /* 0x05 Vertical Active lsb */ 160 0x06, 0x80, /* 0x06 Horizontal Delay lsb */ 161 0x07, 0xd0, /* 0x07 Horizontal Active lsb */ 162 0x08, 0x00, /* 0x08 Horizontal Scaling msb */ 163 0x09, 0xf8, /* 0x09 Horizontal Scaling lsb */ 164 0x0a, 0x00, /* 0x0a Brightness control */ 165 0x0b, 0x30, /* 0x0b Miscellaneous control */ 166 0x0c, 0xd8, /* 0x0c Luma Gain lsb */ 167 0x0d, 0xfe, /* 0x0d Chroma Gain (U) lsb */ 168 0x0e, 0xb4, /* 0x0e Chroma Gain (V) msb */ 169 0x0f, 0x00, /* 0x0f Hue control */ 170 0x12, 0x04, /* 0x12 Output Format */ 171 0x13, 0x20, /* 0x13 Vertial Scaling msb 0x00 172 chroma comb OFF, line drop scaling, interlace scaling 173 BUG? Why does turning the chroma comb on fuck up color? 174 Bug in the bt819 stepping on my board? 175 */ 176 0x14, 0x00, /* 0x14 Vertial Scaling lsb */ 177 0x16, 0x07, /* 0x16 Video Timing Polarity 178 ACTIVE=active low 179 FIELD: high=odd, 180 vreset=active high, 181 hreset=active high */ 182 0x18, 0x68, /* 0x18 AGC Delay */ 183 0x19, 0x5d, /* 0x19 Burst Gate Delay */ 184 0x1a, 0x80, /* 0x1a ADC Interface */ 185 }; 186 187 struct bt819 *decoder = to_bt819(sd); 188 struct timing *timing = &timing_data[(decoder->norm & V4L2_STD_525_60) ? 1 : 0]; 189 190 init[0x03 * 2 - 1] = 191 (((timing->vdelay >> 8) & 0x03) << 6) | 192 (((timing->vactive >> 8) & 0x03) << 4) | 193 (((timing->hdelay >> 8) & 0x03) << 2) | 194 ((timing->hactive >> 8) & 0x03); 195 init[0x04 * 2 - 1] = timing->vdelay & 0xff; 196 init[0x05 * 2 - 1] = timing->vactive & 0xff; 197 init[0x06 * 2 - 1] = timing->hdelay & 0xff; 198 init[0x07 * 2 - 1] = timing->hactive & 0xff; 199 init[0x08 * 2 - 1] = timing->hscale >> 8; 200 init[0x09 * 2 - 1] = timing->hscale & 0xff; 201 /* 0x15 in array is address 0x19 */ 202 init[0x15 * 2 - 1] = (decoder->norm & V4L2_STD_625_50) ? 115 : 93; /* Chroma burst delay */ 203 /* reset */ 204 bt819_write(decoder, 0x1f, 0x00); 205 mdelay(1); 206 207 /* init */ 208 return bt819_write_block(decoder, init, sizeof(init)); 209 } 210 211 /* ----------------------------------------------------------------------- */ 212 213 static int bt819_status(struct v4l2_subdev *sd, u32 *pstatus, v4l2_std_id *pstd) 214 { 215 struct bt819 *decoder = to_bt819(sd); 216 int status = bt819_read(decoder, 0x00); 217 int res = V4L2_IN_ST_NO_SIGNAL; 218 v4l2_std_id std = pstd ? *pstd : V4L2_STD_ALL; 219 220 if ((status & 0x80)) 221 res = 0; 222 else 223 std = V4L2_STD_UNKNOWN; 224 225 if ((status & 0x10)) 226 std &= V4L2_STD_PAL; 227 else 228 std &= V4L2_STD_NTSC; 229 if (pstd) 230 *pstd = std; 231 if (pstatus) 232 *pstatus = res; 233 234 v4l2_dbg(1, debug, sd, "get status %x\n", status); 235 return 0; 236 } 237 238 static int bt819_querystd(struct v4l2_subdev *sd, v4l2_std_id *std) 239 { 240 return bt819_status(sd, NULL, std); 241 } 242 243 static int bt819_g_input_status(struct v4l2_subdev *sd, u32 *status) 244 { 245 return bt819_status(sd, status, NULL); 246 } 247 248 static int bt819_s_std(struct v4l2_subdev *sd, v4l2_std_id std) 249 { 250 struct bt819 *decoder = to_bt819(sd); 251 struct timing *timing = NULL; 252 253 v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std); 254 255 if (sd->v4l2_dev == NULL || sd->v4l2_dev->notify == NULL) 256 v4l2_err(sd, "no notify found!\n"); 257 258 if (std & V4L2_STD_NTSC) { 259 v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL); 260 bt819_setbit(decoder, 0x01, 0, 1); 261 bt819_setbit(decoder, 0x01, 1, 0); 262 bt819_setbit(decoder, 0x01, 5, 0); 263 bt819_write(decoder, 0x18, 0x68); 264 bt819_write(decoder, 0x19, 0x5d); 265 /* bt819_setbit(decoder, 0x1a, 5, 1); */ 266 timing = &timing_data[1]; 267 } else if (std & V4L2_STD_PAL) { 268 v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL); 269 bt819_setbit(decoder, 0x01, 0, 1); 270 bt819_setbit(decoder, 0x01, 1, 1); 271 bt819_setbit(decoder, 0x01, 5, 1); 272 bt819_write(decoder, 0x18, 0x7f); 273 bt819_write(decoder, 0x19, 0x72); 274 /* bt819_setbit(decoder, 0x1a, 5, 0); */ 275 timing = &timing_data[0]; 276 } else { 277 v4l2_dbg(1, debug, sd, "unsupported norm %llx\n", 278 (unsigned long long)std); 279 return -EINVAL; 280 } 281 bt819_write(decoder, 0x03, 282 (((timing->vdelay >> 8) & 0x03) << 6) | 283 (((timing->vactive >> 8) & 0x03) << 4) | 284 (((timing->hdelay >> 8) & 0x03) << 2) | 285 ((timing->hactive >> 8) & 0x03)); 286 bt819_write(decoder, 0x04, timing->vdelay & 0xff); 287 bt819_write(decoder, 0x05, timing->vactive & 0xff); 288 bt819_write(decoder, 0x06, timing->hdelay & 0xff); 289 bt819_write(decoder, 0x07, timing->hactive & 0xff); 290 bt819_write(decoder, 0x08, (timing->hscale >> 8) & 0xff); 291 bt819_write(decoder, 0x09, timing->hscale & 0xff); 292 decoder->norm = std; 293 v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL); 294 return 0; 295 } 296 297 static int bt819_s_routing(struct v4l2_subdev *sd, 298 u32 input, u32 output, u32 config) 299 { 300 struct bt819 *decoder = to_bt819(sd); 301 302 v4l2_dbg(1, debug, sd, "set input %x\n", input); 303 304 if (input > 7) 305 return -EINVAL; 306 307 if (sd->v4l2_dev == NULL || sd->v4l2_dev->notify == NULL) 308 v4l2_err(sd, "no notify found!\n"); 309 310 if (decoder->input != input) { 311 v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL); 312 decoder->input = input; 313 /* select mode */ 314 if (decoder->input == 0) { 315 bt819_setbit(decoder, 0x0b, 6, 0); 316 bt819_setbit(decoder, 0x1a, 1, 1); 317 } else { 318 bt819_setbit(decoder, 0x0b, 6, 1); 319 bt819_setbit(decoder, 0x1a, 1, 0); 320 } 321 v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL); 322 } 323 return 0; 324 } 325 326 static int bt819_s_stream(struct v4l2_subdev *sd, int enable) 327 { 328 struct bt819 *decoder = to_bt819(sd); 329 330 v4l2_dbg(1, debug, sd, "enable output %x\n", enable); 331 332 if (decoder->enable != enable) { 333 decoder->enable = enable; 334 bt819_setbit(decoder, 0x16, 7, !enable); 335 } 336 return 0; 337 } 338 339 static int bt819_s_ctrl(struct v4l2_ctrl *ctrl) 340 { 341 struct v4l2_subdev *sd = to_sd(ctrl); 342 struct bt819 *decoder = to_bt819(sd); 343 int temp; 344 345 switch (ctrl->id) { 346 case V4L2_CID_BRIGHTNESS: 347 bt819_write(decoder, 0x0a, ctrl->val); 348 break; 349 350 case V4L2_CID_CONTRAST: 351 bt819_write(decoder, 0x0c, ctrl->val & 0xff); 352 bt819_setbit(decoder, 0x0b, 2, ((ctrl->val >> 8) & 0x01)); 353 break; 354 355 case V4L2_CID_SATURATION: 356 bt819_write(decoder, 0x0d, (ctrl->val >> 7) & 0xff); 357 bt819_setbit(decoder, 0x0b, 1, ((ctrl->val >> 15) & 0x01)); 358 359 /* Ratio between U gain and V gain must stay the same as 360 the ratio between the default U and V gain values. */ 361 temp = (ctrl->val * 180) / 254; 362 bt819_write(decoder, 0x0e, (temp >> 7) & 0xff); 363 bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01); 364 break; 365 366 case V4L2_CID_HUE: 367 bt819_write(decoder, 0x0f, ctrl->val); 368 break; 369 370 default: 371 return -EINVAL; 372 } 373 return 0; 374 } 375 376 /* ----------------------------------------------------------------------- */ 377 378 static const struct v4l2_ctrl_ops bt819_ctrl_ops = { 379 .s_ctrl = bt819_s_ctrl, 380 }; 381 382 static const struct v4l2_subdev_core_ops bt819_core_ops = { 383 .g_ext_ctrls = v4l2_subdev_g_ext_ctrls, 384 .try_ext_ctrls = v4l2_subdev_try_ext_ctrls, 385 .s_ext_ctrls = v4l2_subdev_s_ext_ctrls, 386 .g_ctrl = v4l2_subdev_g_ctrl, 387 .s_ctrl = v4l2_subdev_s_ctrl, 388 .queryctrl = v4l2_subdev_queryctrl, 389 .querymenu = v4l2_subdev_querymenu, 390 }; 391 392 static const struct v4l2_subdev_video_ops bt819_video_ops = { 393 .s_std = bt819_s_std, 394 .s_routing = bt819_s_routing, 395 .s_stream = bt819_s_stream, 396 .querystd = bt819_querystd, 397 .g_input_status = bt819_g_input_status, 398 }; 399 400 static const struct v4l2_subdev_ops bt819_ops = { 401 .core = &bt819_core_ops, 402 .video = &bt819_video_ops, 403 }; 404 405 /* ----------------------------------------------------------------------- */ 406 407 static int bt819_probe(struct i2c_client *client, 408 const struct i2c_device_id *id) 409 { 410 int i, ver; 411 struct bt819 *decoder; 412 struct v4l2_subdev *sd; 413 const char *name; 414 415 /* Check if the adapter supports the needed features */ 416 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 417 return -ENODEV; 418 419 decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL); 420 if (decoder == NULL) 421 return -ENOMEM; 422 sd = &decoder->sd; 423 v4l2_i2c_subdev_init(sd, client, &bt819_ops); 424 425 ver = bt819_read(decoder, 0x17); 426 switch (ver & 0xf0) { 427 case 0x70: 428 name = "bt819a"; 429 break; 430 case 0x60: 431 name = "bt817a"; 432 break; 433 case 0x20: 434 name = "bt815a"; 435 break; 436 default: 437 v4l2_dbg(1, debug, sd, 438 "unknown chip version 0x%02x\n", ver); 439 return -ENODEV; 440 } 441 442 v4l_info(client, "%s found @ 0x%x (%s)\n", name, 443 client->addr << 1, client->adapter->name); 444 445 decoder->norm = V4L2_STD_NTSC; 446 decoder->input = 0; 447 decoder->enable = 1; 448 449 i = bt819_init(sd); 450 if (i < 0) 451 v4l2_dbg(1, debug, sd, "init status %d\n", i); 452 453 v4l2_ctrl_handler_init(&decoder->hdl, 4); 454 v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops, 455 V4L2_CID_BRIGHTNESS, -128, 127, 1, 0); 456 v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops, 457 V4L2_CID_CONTRAST, 0, 511, 1, 0xd8); 458 v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops, 459 V4L2_CID_SATURATION, 0, 511, 1, 0xfe); 460 v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops, 461 V4L2_CID_HUE, -128, 127, 1, 0); 462 sd->ctrl_handler = &decoder->hdl; 463 if (decoder->hdl.error) { 464 int err = decoder->hdl.error; 465 466 v4l2_ctrl_handler_free(&decoder->hdl); 467 return err; 468 } 469 v4l2_ctrl_handler_setup(&decoder->hdl); 470 return 0; 471 } 472 473 static int bt819_remove(struct i2c_client *client) 474 { 475 struct v4l2_subdev *sd = i2c_get_clientdata(client); 476 struct bt819 *decoder = to_bt819(sd); 477 478 v4l2_device_unregister_subdev(sd); 479 v4l2_ctrl_handler_free(&decoder->hdl); 480 return 0; 481 } 482 483 /* ----------------------------------------------------------------------- */ 484 485 static const struct i2c_device_id bt819_id[] = { 486 { "bt819a", 0 }, 487 { "bt817a", 0 }, 488 { "bt815a", 0 }, 489 { } 490 }; 491 MODULE_DEVICE_TABLE(i2c, bt819_id); 492 493 static struct i2c_driver bt819_driver = { 494 .driver = { 495 .owner = THIS_MODULE, 496 .name = "bt819", 497 }, 498 .probe = bt819_probe, 499 .remove = bt819_remove, 500 .id_table = bt819_id, 501 }; 502 503 module_i2c_driver(bt819_driver); 504