saa6752hs.c revision c6e8d86fffd8edf1bfccbd441b1812ee919fe3d5
1 /* 2 saa6752hs - i2c-driver for the saa6752hs by Philips 3 4 Copyright (C) 2004 Andrew de Quincey 5 6 AC-3 support: 7 8 Copyright (C) 2008 Hans Verkuil <hverkuil@xs4all.nl> 9 10 This program is free software; you can redistribute it and/or modify 11 it under the terms of the GNU General Public License vs published by 12 the Free Software Foundation; either version 2 of the License, or 13 (at your option) any later version. 14 15 This program is distributed in the hope that it will be useful, 16 but WITHOUT ANY WARRANTY; without even the implied warranty of 17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 18 GNU General Public License for more details. 19 20 You should have received a copy of the GNU General Public License 21 along with this program; if not, write to the Free Software 22 Foundation, Inc., 675 Mvss Ave, Cambridge, MA 02139, USA. 23 */ 24 25#include <linux/module.h> 26#include <linux/kernel.h> 27#include <linux/string.h> 28#include <linux/timer.h> 29#include <linux/delay.h> 30#include <linux/errno.h> 31#include <linux/slab.h> 32#include <linux/poll.h> 33#include <linux/i2c.h> 34#include <linux/types.h> 35#include <linux/videodev2.h> 36#include <media/v4l2-device.h> 37#include <media/v4l2-common.h> 38#include <media/v4l2-chip-ident.h> 39#include <linux/init.h> 40#include <linux/crc32.h> 41 42#define MPEG_VIDEO_TARGET_BITRATE_MAX 27000 43#define MPEG_VIDEO_MAX_BITRATE_MAX 27000 44#define MPEG_TOTAL_TARGET_BITRATE_MAX 27000 45#define MPEG_PID_MAX ((1 << 14) - 1) 46 47 48MODULE_DESCRIPTION("device driver for saa6752hs MPEG2 encoder"); 49MODULE_AUTHOR("Andrew de Quincey"); 50MODULE_LICENSE("GPL"); 51 52enum saa6752hs_videoformat { 53 SAA6752HS_VF_D1 = 0, /* standard D1 video format: 720x576 */ 54 SAA6752HS_VF_2_3_D1 = 1,/* 2/3D1 video format: 480x576 */ 55 SAA6752HS_VF_1_2_D1 = 2,/* 1/2D1 video format: 352x576 */ 56 SAA6752HS_VF_SIF = 3, /* SIF video format: 352x288 */ 57 SAA6752HS_VF_UNKNOWN, 58}; 59 60struct saa6752hs_mpeg_params { 61 /* transport streams */ 62 __u16 ts_pid_pmt; 63 __u16 ts_pid_audio; 64 __u16 ts_pid_video; 65 __u16 ts_pid_pcr; 66 67 /* audio */ 68 enum v4l2_mpeg_audio_encoding au_encoding; 69 enum v4l2_mpeg_audio_l2_bitrate au_l2_bitrate; 70 enum v4l2_mpeg_audio_ac3_bitrate au_ac3_bitrate; 71 72 /* video */ 73 enum v4l2_mpeg_video_aspect vi_aspect; 74 enum v4l2_mpeg_video_bitrate_mode vi_bitrate_mode; 75 __u32 vi_bitrate; 76 __u32 vi_bitrate_peak; 77}; 78 79static const struct v4l2_format v4l2_format_table[] = 80{ 81 [SAA6752HS_VF_D1] = 82 { .fmt = { .pix = { .width = 720, .height = 576 }}}, 83 [SAA6752HS_VF_2_3_D1] = 84 { .fmt = { .pix = { .width = 480, .height = 576 }}}, 85 [SAA6752HS_VF_1_2_D1] = 86 { .fmt = { .pix = { .width = 352, .height = 576 }}}, 87 [SAA6752HS_VF_SIF] = 88 { .fmt = { .pix = { .width = 352, .height = 288 }}}, 89 [SAA6752HS_VF_UNKNOWN] = 90 { .fmt = { .pix = { .width = 0, .height = 0}}}, 91}; 92 93struct saa6752hs_state { 94 struct v4l2_subdev sd; 95 int chip; 96 u32 revision; 97 int has_ac3; 98 struct saa6752hs_mpeg_params params; 99 enum saa6752hs_videoformat video_format; 100 v4l2_std_id standard; 101}; 102 103enum saa6752hs_command { 104 SAA6752HS_COMMAND_RESET = 0, 105 SAA6752HS_COMMAND_STOP = 1, 106 SAA6752HS_COMMAND_START = 2, 107 SAA6752HS_COMMAND_PAUSE = 3, 108 SAA6752HS_COMMAND_RECONFIGURE = 4, 109 SAA6752HS_COMMAND_SLEEP = 5, 110 SAA6752HS_COMMAND_RECONFIGURE_FORCE = 6, 111 112 SAA6752HS_COMMAND_MAX 113}; 114 115static inline struct saa6752hs_state *to_state(struct v4l2_subdev *sd) 116{ 117 return container_of(sd, struct saa6752hs_state, sd); 118} 119 120/* ---------------------------------------------------------------------- */ 121 122static u8 PAT[] = { 123 0xc2, /* i2c register */ 124 0x00, /* table number for encoder */ 125 126 0x47, /* sync */ 127 0x40, 0x00, /* transport_error_indicator(0), payload_unit_start(1), transport_priority(0), pid(0) */ 128 0x10, /* transport_scrambling_control(00), adaptation_field_control(01), continuity_counter(0) */ 129 130 0x00, /* PSI pointer to start of table */ 131 132 0x00, /* tid(0) */ 133 0xb0, 0x0d, /* section_syntax_indicator(1), section_length(13) */ 134 135 0x00, 0x01, /* transport_stream_id(1) */ 136 137 0xc1, /* version_number(0), current_next_indicator(1) */ 138 139 0x00, 0x00, /* section_number(0), last_section_number(0) */ 140 141 0x00, 0x01, /* program_number(1) */ 142 143 0xe0, 0x00, /* PMT PID */ 144 145 0x00, 0x00, 0x00, 0x00 /* CRC32 */ 146}; 147 148static u8 PMT[] = { 149 0xc2, /* i2c register */ 150 0x01, /* table number for encoder */ 151 152 0x47, /* sync */ 153 0x40, 0x00, /* transport_error_indicator(0), payload_unit_start(1), transport_priority(0), pid */ 154 0x10, /* transport_scrambling_control(00), adaptation_field_control(01), continuity_counter(0) */ 155 156 0x00, /* PSI pointer to start of table */ 157 158 0x02, /* tid(2) */ 159 0xb0, 0x17, /* section_syntax_indicator(1), section_length(23) */ 160 161 0x00, 0x01, /* program_number(1) */ 162 163 0xc1, /* version_number(0), current_next_indicator(1) */ 164 165 0x00, 0x00, /* section_number(0), last_section_number(0) */ 166 167 0xe0, 0x00, /* PCR_PID */ 168 169 0xf0, 0x00, /* program_info_length(0) */ 170 171 0x02, 0xe0, 0x00, 0xf0, 0x00, /* video stream type(2), pid */ 172 0x04, 0xe0, 0x00, 0xf0, 0x00, /* audio stream type(4), pid */ 173 174 0x00, 0x00, 0x00, 0x00 /* CRC32 */ 175}; 176 177static u8 PMT_AC3[] = { 178 0xc2, /* i2c register */ 179 0x01, /* table number for encoder(1) */ 180 0x47, /* sync */ 181 182 0x40, /* transport_error_indicator(0), payload_unit_start(1), transport_priority(0) */ 183 0x10, /* PMT PID (0x0010) */ 184 0x10, /* transport_scrambling_control(00), adaptation_field_control(01), continuity_counter(0) */ 185 186 0x00, /* PSI pointer to start of table */ 187 188 0x02, /* TID (2) */ 189 0xb0, 0x1a, /* section_syntax_indicator(1), section_length(26) */ 190 191 0x00, 0x01, /* program_number(1) */ 192 193 0xc1, /* version_number(0), current_next_indicator(1) */ 194 195 0x00, 0x00, /* section_number(0), last_section_number(0) */ 196 197 0xe1, 0x04, /* PCR_PID (0x0104) */ 198 199 0xf0, 0x00, /* program_info_length(0) */ 200 201 0x02, 0xe1, 0x00, 0xf0, 0x00, /* video stream type(2), pid */ 202 0x06, 0xe1, 0x03, 0xf0, 0x03, /* audio stream type(6), pid */ 203 0x6a, /* AC3 */ 204 0x01, /* Descriptor_length(1) */ 205 0x00, /* component_type_flag(0), bsid_flag(0), mainid_flag(0), asvc_flag(0), reserved flags(0) */ 206 207 0xED, 0xDE, 0x2D, 0xF3 /* CRC32 BE */ 208}; 209 210static struct saa6752hs_mpeg_params param_defaults = 211{ 212 .ts_pid_pmt = 16, 213 .ts_pid_video = 260, 214 .ts_pid_audio = 256, 215 .ts_pid_pcr = 259, 216 217 .vi_aspect = V4L2_MPEG_VIDEO_ASPECT_4x3, 218 .vi_bitrate = 4000, 219 .vi_bitrate_peak = 6000, 220 .vi_bitrate_mode = V4L2_MPEG_VIDEO_BITRATE_MODE_VBR, 221 222 .au_encoding = V4L2_MPEG_AUDIO_ENCODING_LAYER_2, 223 .au_l2_bitrate = V4L2_MPEG_AUDIO_L2_BITRATE_256K, 224 .au_ac3_bitrate = V4L2_MPEG_AUDIO_AC3_BITRATE_256K, 225}; 226 227/* ---------------------------------------------------------------------- */ 228 229static int saa6752hs_chip_command(struct i2c_client *client, 230 enum saa6752hs_command command) 231{ 232 unsigned char buf[3]; 233 unsigned long timeout; 234 int status = 0; 235 236 /* execute the command */ 237 switch(command) { 238 case SAA6752HS_COMMAND_RESET: 239 buf[0] = 0x00; 240 break; 241 242 case SAA6752HS_COMMAND_STOP: 243 buf[0] = 0x03; 244 break; 245 246 case SAA6752HS_COMMAND_START: 247 buf[0] = 0x02; 248 break; 249 250 case SAA6752HS_COMMAND_PAUSE: 251 buf[0] = 0x04; 252 break; 253 254 case SAA6752HS_COMMAND_RECONFIGURE: 255 buf[0] = 0x05; 256 break; 257 258 case SAA6752HS_COMMAND_SLEEP: 259 buf[0] = 0x06; 260 break; 261 262 case SAA6752HS_COMMAND_RECONFIGURE_FORCE: 263 buf[0] = 0x07; 264 break; 265 266 default: 267 return -EINVAL; 268 } 269 270 /* set it and wait for it to be so */ 271 i2c_master_send(client, buf, 1); 272 timeout = jiffies + HZ * 3; 273 for (;;) { 274 /* get the current status */ 275 buf[0] = 0x10; 276 i2c_master_send(client, buf, 1); 277 i2c_master_recv(client, buf, 1); 278 279 if (!(buf[0] & 0x20)) 280 break; 281 if (time_after(jiffies,timeout)) { 282 status = -ETIMEDOUT; 283 break; 284 } 285 286 msleep(10); 287 } 288 289 /* delay a bit to let encoder settle */ 290 msleep(50); 291 292 return status; 293} 294 295 296static inline void set_reg8(struct i2c_client *client, uint8_t reg, uint8_t val) 297{ 298 u8 buf[2]; 299 300 buf[0] = reg; 301 buf[1] = val; 302 i2c_master_send(client, buf, 2); 303} 304 305static inline void set_reg16(struct i2c_client *client, uint8_t reg, uint16_t val) 306{ 307 u8 buf[3]; 308 309 buf[0] = reg; 310 buf[1] = val >> 8; 311 buf[2] = val & 0xff; 312 i2c_master_send(client, buf, 3); 313} 314 315static int saa6752hs_set_bitrate(struct i2c_client *client, 316 struct saa6752hs_state *h) 317{ 318 struct saa6752hs_mpeg_params *params = &h->params; 319 int tot_bitrate; 320 int is_384k; 321 322 /* set the bitrate mode */ 323 set_reg8(client, 0x71, 324 params->vi_bitrate_mode != V4L2_MPEG_VIDEO_BITRATE_MODE_VBR); 325 326 /* set the video bitrate */ 327 if (params->vi_bitrate_mode == V4L2_MPEG_VIDEO_BITRATE_MODE_VBR) { 328 /* set the target bitrate */ 329 set_reg16(client, 0x80, params->vi_bitrate); 330 331 /* set the max bitrate */ 332 set_reg16(client, 0x81, params->vi_bitrate_peak); 333 tot_bitrate = params->vi_bitrate_peak; 334 } else { 335 /* set the target bitrate (no max bitrate for CBR) */ 336 set_reg16(client, 0x81, params->vi_bitrate); 337 tot_bitrate = params->vi_bitrate; 338 } 339 340 /* set the audio encoding */ 341 set_reg8(client, 0x93, 342 params->au_encoding == V4L2_MPEG_AUDIO_ENCODING_AC3); 343 344 /* set the audio bitrate */ 345 if (params->au_encoding == V4L2_MPEG_AUDIO_ENCODING_AC3) 346 is_384k = V4L2_MPEG_AUDIO_AC3_BITRATE_384K == params->au_ac3_bitrate; 347 else 348 is_384k = V4L2_MPEG_AUDIO_L2_BITRATE_384K == params->au_l2_bitrate; 349 set_reg8(client, 0x94, is_384k); 350 tot_bitrate += is_384k ? 384 : 256; 351 352 /* Note: the total max bitrate is determined by adding the video and audio 353 bitrates together and also adding an extra 768kbit/s to stay on the 354 safe side. If more control should be required, then an extra MPEG control 355 should be added. */ 356 tot_bitrate += 768; 357 if (tot_bitrate > MPEG_TOTAL_TARGET_BITRATE_MAX) 358 tot_bitrate = MPEG_TOTAL_TARGET_BITRATE_MAX; 359 360 /* set the total bitrate */ 361 set_reg16(client, 0xb1, tot_bitrate); 362 return 0; 363} 364 365 366static int get_ctrl(int has_ac3, struct saa6752hs_mpeg_params *params, 367 struct v4l2_ext_control *ctrl) 368{ 369 switch (ctrl->id) { 370 case V4L2_CID_MPEG_STREAM_TYPE: 371 ctrl->value = V4L2_MPEG_STREAM_TYPE_MPEG2_TS; 372 break; 373 case V4L2_CID_MPEG_STREAM_PID_PMT: 374 ctrl->value = params->ts_pid_pmt; 375 break; 376 case V4L2_CID_MPEG_STREAM_PID_AUDIO: 377 ctrl->value = params->ts_pid_audio; 378 break; 379 case V4L2_CID_MPEG_STREAM_PID_VIDEO: 380 ctrl->value = params->ts_pid_video; 381 break; 382 case V4L2_CID_MPEG_STREAM_PID_PCR: 383 ctrl->value = params->ts_pid_pcr; 384 break; 385 case V4L2_CID_MPEG_AUDIO_ENCODING: 386 ctrl->value = params->au_encoding; 387 break; 388 case V4L2_CID_MPEG_AUDIO_L2_BITRATE: 389 ctrl->value = params->au_l2_bitrate; 390 break; 391 case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: 392 if (!has_ac3) 393 return -EINVAL; 394 ctrl->value = params->au_ac3_bitrate; 395 break; 396 case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: 397 ctrl->value = V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000; 398 break; 399 case V4L2_CID_MPEG_VIDEO_ENCODING: 400 ctrl->value = V4L2_MPEG_VIDEO_ENCODING_MPEG_2; 401 break; 402 case V4L2_CID_MPEG_VIDEO_ASPECT: 403 ctrl->value = params->vi_aspect; 404 break; 405 case V4L2_CID_MPEG_VIDEO_BITRATE: 406 ctrl->value = params->vi_bitrate * 1000; 407 break; 408 case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK: 409 ctrl->value = params->vi_bitrate_peak * 1000; 410 break; 411 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: 412 ctrl->value = params->vi_bitrate_mode; 413 break; 414 default: 415 return -EINVAL; 416 } 417 return 0; 418} 419 420static int handle_ctrl(int has_ac3, struct saa6752hs_mpeg_params *params, 421 struct v4l2_ext_control *ctrl, int set) 422{ 423 int old = 0, new; 424 425 new = ctrl->value; 426 switch (ctrl->id) { 427 case V4L2_CID_MPEG_STREAM_TYPE: 428 old = V4L2_MPEG_STREAM_TYPE_MPEG2_TS; 429 if (set && new != old) 430 return -ERANGE; 431 new = old; 432 break; 433 case V4L2_CID_MPEG_STREAM_PID_PMT: 434 old = params->ts_pid_pmt; 435 if (set && new > MPEG_PID_MAX) 436 return -ERANGE; 437 if (new > MPEG_PID_MAX) 438 new = MPEG_PID_MAX; 439 params->ts_pid_pmt = new; 440 break; 441 case V4L2_CID_MPEG_STREAM_PID_AUDIO: 442 old = params->ts_pid_audio; 443 if (set && new > MPEG_PID_MAX) 444 return -ERANGE; 445 if (new > MPEG_PID_MAX) 446 new = MPEG_PID_MAX; 447 params->ts_pid_audio = new; 448 break; 449 case V4L2_CID_MPEG_STREAM_PID_VIDEO: 450 old = params->ts_pid_video; 451 if (set && new > MPEG_PID_MAX) 452 return -ERANGE; 453 if (new > MPEG_PID_MAX) 454 new = MPEG_PID_MAX; 455 params->ts_pid_video = new; 456 break; 457 case V4L2_CID_MPEG_STREAM_PID_PCR: 458 old = params->ts_pid_pcr; 459 if (set && new > MPEG_PID_MAX) 460 return -ERANGE; 461 if (new > MPEG_PID_MAX) 462 new = MPEG_PID_MAX; 463 params->ts_pid_pcr = new; 464 break; 465 case V4L2_CID_MPEG_AUDIO_ENCODING: 466 old = params->au_encoding; 467 if (set && new != V4L2_MPEG_AUDIO_ENCODING_LAYER_2 && 468 (!has_ac3 || new != V4L2_MPEG_AUDIO_ENCODING_AC3)) 469 return -ERANGE; 470 params->au_encoding = new; 471 break; 472 case V4L2_CID_MPEG_AUDIO_L2_BITRATE: 473 old = params->au_l2_bitrate; 474 if (set && new != V4L2_MPEG_AUDIO_L2_BITRATE_256K && 475 new != V4L2_MPEG_AUDIO_L2_BITRATE_384K) 476 return -ERANGE; 477 if (new <= V4L2_MPEG_AUDIO_L2_BITRATE_256K) 478 new = V4L2_MPEG_AUDIO_L2_BITRATE_256K; 479 else 480 new = V4L2_MPEG_AUDIO_L2_BITRATE_384K; 481 params->au_l2_bitrate = new; 482 break; 483 case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: 484 if (!has_ac3) 485 return -EINVAL; 486 old = params->au_ac3_bitrate; 487 if (set && new != V4L2_MPEG_AUDIO_AC3_BITRATE_256K && 488 new != V4L2_MPEG_AUDIO_AC3_BITRATE_384K) 489 return -ERANGE; 490 if (new <= V4L2_MPEG_AUDIO_AC3_BITRATE_256K) 491 new = V4L2_MPEG_AUDIO_AC3_BITRATE_256K; 492 else 493 new = V4L2_MPEG_AUDIO_AC3_BITRATE_384K; 494 params->au_ac3_bitrate = new; 495 break; 496 case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: 497 old = V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000; 498 if (set && new != old) 499 return -ERANGE; 500 new = old; 501 break; 502 case V4L2_CID_MPEG_VIDEO_ENCODING: 503 old = V4L2_MPEG_VIDEO_ENCODING_MPEG_2; 504 if (set && new != old) 505 return -ERANGE; 506 new = old; 507 break; 508 case V4L2_CID_MPEG_VIDEO_ASPECT: 509 old = params->vi_aspect; 510 if (set && new != V4L2_MPEG_VIDEO_ASPECT_16x9 && 511 new != V4L2_MPEG_VIDEO_ASPECT_4x3) 512 return -ERANGE; 513 if (new != V4L2_MPEG_VIDEO_ASPECT_16x9) 514 new = V4L2_MPEG_VIDEO_ASPECT_4x3; 515 params->vi_aspect = new; 516 break; 517 case V4L2_CID_MPEG_VIDEO_BITRATE: 518 old = params->vi_bitrate * 1000; 519 new = 1000 * (new / 1000); 520 if (set && new > MPEG_VIDEO_TARGET_BITRATE_MAX * 1000) 521 return -ERANGE; 522 if (new > MPEG_VIDEO_TARGET_BITRATE_MAX * 1000) 523 new = MPEG_VIDEO_TARGET_BITRATE_MAX * 1000; 524 params->vi_bitrate = new / 1000; 525 break; 526 case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK: 527 old = params->vi_bitrate_peak * 1000; 528 new = 1000 * (new / 1000); 529 if (set && new > MPEG_VIDEO_TARGET_BITRATE_MAX * 1000) 530 return -ERANGE; 531 if (new > MPEG_VIDEO_TARGET_BITRATE_MAX * 1000) 532 new = MPEG_VIDEO_TARGET_BITRATE_MAX * 1000; 533 params->vi_bitrate_peak = new / 1000; 534 break; 535 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: 536 old = params->vi_bitrate_mode; 537 params->vi_bitrate_mode = new; 538 break; 539 default: 540 return -EINVAL; 541 } 542 ctrl->value = new; 543 return 0; 544} 545 546 547static int saa6752hs_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qctrl) 548{ 549 struct saa6752hs_state *h = to_state(sd); 550 struct saa6752hs_mpeg_params *params = &h->params; 551 int err; 552 553 switch (qctrl->id) { 554 case V4L2_CID_MPEG_AUDIO_ENCODING: 555 return v4l2_ctrl_query_fill(qctrl, 556 V4L2_MPEG_AUDIO_ENCODING_LAYER_2, 557 h->has_ac3 ? V4L2_MPEG_AUDIO_ENCODING_AC3 : 558 V4L2_MPEG_AUDIO_ENCODING_LAYER_2, 559 1, V4L2_MPEG_AUDIO_ENCODING_LAYER_2); 560 561 case V4L2_CID_MPEG_AUDIO_L2_BITRATE: 562 return v4l2_ctrl_query_fill(qctrl, 563 V4L2_MPEG_AUDIO_L2_BITRATE_256K, 564 V4L2_MPEG_AUDIO_L2_BITRATE_384K, 1, 565 V4L2_MPEG_AUDIO_L2_BITRATE_256K); 566 567 case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: 568 if (!h->has_ac3) 569 return -EINVAL; 570 return v4l2_ctrl_query_fill(qctrl, 571 V4L2_MPEG_AUDIO_AC3_BITRATE_256K, 572 V4L2_MPEG_AUDIO_AC3_BITRATE_384K, 1, 573 V4L2_MPEG_AUDIO_AC3_BITRATE_256K); 574 575 case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: 576 return v4l2_ctrl_query_fill(qctrl, 577 V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000, 578 V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000, 1, 579 V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000); 580 581 case V4L2_CID_MPEG_VIDEO_ENCODING: 582 return v4l2_ctrl_query_fill(qctrl, 583 V4L2_MPEG_VIDEO_ENCODING_MPEG_2, 584 V4L2_MPEG_VIDEO_ENCODING_MPEG_2, 1, 585 V4L2_MPEG_VIDEO_ENCODING_MPEG_2); 586 587 case V4L2_CID_MPEG_VIDEO_ASPECT: 588 return v4l2_ctrl_query_fill(qctrl, 589 V4L2_MPEG_VIDEO_ASPECT_4x3, 590 V4L2_MPEG_VIDEO_ASPECT_16x9, 1, 591 V4L2_MPEG_VIDEO_ASPECT_4x3); 592 593 case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK: 594 err = v4l2_ctrl_query_fill(qctrl, 0, 27000000, 1, 8000000); 595 if (err == 0 && 596 params->vi_bitrate_mode == 597 V4L2_MPEG_VIDEO_BITRATE_MODE_CBR) 598 qctrl->flags |= V4L2_CTRL_FLAG_INACTIVE; 599 return err; 600 601 case V4L2_CID_MPEG_STREAM_TYPE: 602 return v4l2_ctrl_query_fill(qctrl, 603 V4L2_MPEG_STREAM_TYPE_MPEG2_TS, 604 V4L2_MPEG_STREAM_TYPE_MPEG2_TS, 1, 605 V4L2_MPEG_STREAM_TYPE_MPEG2_TS); 606 607 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: 608 return v4l2_ctrl_query_fill(qctrl, 609 V4L2_MPEG_VIDEO_BITRATE_MODE_VBR, 610 V4L2_MPEG_VIDEO_BITRATE_MODE_CBR, 1, 611 V4L2_MPEG_VIDEO_BITRATE_MODE_VBR); 612 case V4L2_CID_MPEG_VIDEO_BITRATE: 613 return v4l2_ctrl_query_fill(qctrl, 0, 27000000, 1, 6000000); 614 case V4L2_CID_MPEG_STREAM_PID_PMT: 615 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 16); 616 case V4L2_CID_MPEG_STREAM_PID_AUDIO: 617 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 260); 618 case V4L2_CID_MPEG_STREAM_PID_VIDEO: 619 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 256); 620 case V4L2_CID_MPEG_STREAM_PID_PCR: 621 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 259); 622 623 default: 624 break; 625 } 626 return -EINVAL; 627} 628 629static int saa6752hs_querymenu(struct v4l2_subdev *sd, struct v4l2_querymenu *qmenu) 630{ 631 static const u32 mpeg_audio_encoding[] = { 632 V4L2_MPEG_AUDIO_ENCODING_LAYER_2, 633 V4L2_CTRL_MENU_IDS_END 634 }; 635 static const u32 mpeg_audio_ac3_encoding[] = { 636 V4L2_MPEG_AUDIO_ENCODING_LAYER_2, 637 V4L2_MPEG_AUDIO_ENCODING_AC3, 638 V4L2_CTRL_MENU_IDS_END 639 }; 640 static u32 mpeg_audio_l2_bitrate[] = { 641 V4L2_MPEG_AUDIO_L2_BITRATE_256K, 642 V4L2_MPEG_AUDIO_L2_BITRATE_384K, 643 V4L2_CTRL_MENU_IDS_END 644 }; 645 static u32 mpeg_audio_ac3_bitrate[] = { 646 V4L2_MPEG_AUDIO_AC3_BITRATE_256K, 647 V4L2_MPEG_AUDIO_AC3_BITRATE_384K, 648 V4L2_CTRL_MENU_IDS_END 649 }; 650 struct saa6752hs_state *h = to_state(sd); 651 struct v4l2_queryctrl qctrl; 652 int err; 653 654 qctrl.id = qmenu->id; 655 err = saa6752hs_queryctrl(sd, &qctrl); 656 if (err) 657 return err; 658 switch (qmenu->id) { 659 case V4L2_CID_MPEG_AUDIO_L2_BITRATE: 660 return v4l2_ctrl_query_menu_valid_items(qmenu, 661 mpeg_audio_l2_bitrate); 662 case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: 663 if (!h->has_ac3) 664 return -EINVAL; 665 return v4l2_ctrl_query_menu_valid_items(qmenu, 666 mpeg_audio_ac3_bitrate); 667 case V4L2_CID_MPEG_AUDIO_ENCODING: 668 return v4l2_ctrl_query_menu_valid_items(qmenu, 669 h->has_ac3 ? mpeg_audio_ac3_encoding : 670 mpeg_audio_encoding); 671 } 672 return v4l2_ctrl_query_menu(qmenu, &qctrl, NULL); 673} 674 675static int saa6752hs_init(struct v4l2_subdev *sd, u32 leading_null_bytes) 676{ 677 unsigned char buf[9], buf2[4]; 678 struct saa6752hs_state *h = to_state(sd); 679 struct i2c_client *client = v4l2_get_subdevdata(sd); 680 unsigned size; 681 u32 crc; 682 unsigned char localPAT[256]; 683 unsigned char localPMT[256]; 684 685 /* Set video format - must be done first as it resets other settings */ 686 set_reg8(client, 0x41, h->video_format); 687 688 /* Set number of lines in input signal */ 689 set_reg8(client, 0x40, (h->standard & V4L2_STD_525_60) ? 1 : 0); 690 691 /* set bitrate */ 692 saa6752hs_set_bitrate(client, h); 693 694 /* Set GOP structure {3, 13} */ 695 set_reg16(client, 0x72, 0x030d); 696 697 /* Set minimum Q-scale {4} */ 698 set_reg8(client, 0x82, 0x04); 699 700 /* Set maximum Q-scale {12} */ 701 set_reg8(client, 0x83, 0x0c); 702 703 /* Set Output Protocol */ 704 set_reg8(client, 0xd0, 0x81); 705 706 /* Set video output stream format {TS} */ 707 set_reg8(client, 0xb0, 0x05); 708 709 /* Set leading null byte for TS */ 710 set_reg16(client, 0xf6, leading_null_bytes); 711 712 /* compute PAT */ 713 memcpy(localPAT, PAT, sizeof(PAT)); 714 localPAT[17] = 0xe0 | ((h->params.ts_pid_pmt >> 8) & 0x0f); 715 localPAT[18] = h->params.ts_pid_pmt & 0xff; 716 crc = crc32_be(~0, &localPAT[7], sizeof(PAT) - 7 - 4); 717 localPAT[sizeof(PAT) - 4] = (crc >> 24) & 0xFF; 718 localPAT[sizeof(PAT) - 3] = (crc >> 16) & 0xFF; 719 localPAT[sizeof(PAT) - 2] = (crc >> 8) & 0xFF; 720 localPAT[sizeof(PAT) - 1] = crc & 0xFF; 721 722 /* compute PMT */ 723 if (h->params.au_encoding == V4L2_MPEG_AUDIO_ENCODING_AC3) { 724 size = sizeof(PMT_AC3); 725 memcpy(localPMT, PMT_AC3, size); 726 } else { 727 size = sizeof(PMT); 728 memcpy(localPMT, PMT, size); 729 } 730 localPMT[3] = 0x40 | ((h->params.ts_pid_pmt >> 8) & 0x0f); 731 localPMT[4] = h->params.ts_pid_pmt & 0xff; 732 localPMT[15] = 0xE0 | ((h->params.ts_pid_pcr >> 8) & 0x0F); 733 localPMT[16] = h->params.ts_pid_pcr & 0xFF; 734 localPMT[20] = 0xE0 | ((h->params.ts_pid_video >> 8) & 0x0F); 735 localPMT[21] = h->params.ts_pid_video & 0xFF; 736 localPMT[25] = 0xE0 | ((h->params.ts_pid_audio >> 8) & 0x0F); 737 localPMT[26] = h->params.ts_pid_audio & 0xFF; 738 crc = crc32_be(~0, &localPMT[7], size - 7 - 4); 739 localPMT[size - 4] = (crc >> 24) & 0xFF; 740 localPMT[size - 3] = (crc >> 16) & 0xFF; 741 localPMT[size - 2] = (crc >> 8) & 0xFF; 742 localPMT[size - 1] = crc & 0xFF; 743 744 /* Set Audio PID */ 745 set_reg16(client, 0xc1, h->params.ts_pid_audio); 746 747 /* Set Video PID */ 748 set_reg16(client, 0xc0, h->params.ts_pid_video); 749 750 /* Set PCR PID */ 751 set_reg16(client, 0xc4, h->params.ts_pid_pcr); 752 753 /* Send SI tables */ 754 i2c_master_send(client, localPAT, sizeof(PAT)); 755 i2c_master_send(client, localPMT, size); 756 757 /* mute then unmute audio. This removes buzzing artefacts */ 758 set_reg8(client, 0xa4, 1); 759 set_reg8(client, 0xa4, 0); 760 761 /* start it going */ 762 saa6752hs_chip_command(client, SAA6752HS_COMMAND_START); 763 764 /* readout current state */ 765 buf[0] = 0xE1; 766 buf[1] = 0xA7; 767 buf[2] = 0xFE; 768 buf[3] = 0x82; 769 buf[4] = 0xB0; 770 i2c_master_send(client, buf, 5); 771 i2c_master_recv(client, buf2, 4); 772 773 /* change aspect ratio */ 774 buf[0] = 0xE0; 775 buf[1] = 0xA7; 776 buf[2] = 0xFE; 777 buf[3] = 0x82; 778 buf[4] = 0xB0; 779 buf[5] = buf2[0]; 780 switch (h->params.vi_aspect) { 781 case V4L2_MPEG_VIDEO_ASPECT_16x9: 782 buf[6] = buf2[1] | 0x40; 783 break; 784 case V4L2_MPEG_VIDEO_ASPECT_4x3: 785 default: 786 buf[6] = buf2[1] & 0xBF; 787 break; 788 } 789 buf[7] = buf2[2]; 790 buf[8] = buf2[3]; 791 i2c_master_send(client, buf, 9); 792 793 return 0; 794} 795 796static int saa6752hs_do_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *ctrls, int set) 797{ 798 struct saa6752hs_state *h = to_state(sd); 799 struct saa6752hs_mpeg_params params; 800 int i; 801 802 if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG) 803 return -EINVAL; 804 805 params = h->params; 806 for (i = 0; i < ctrls->count; i++) { 807 int err = handle_ctrl(h->has_ac3, ¶ms, ctrls->controls + i, set); 808 809 if (err) { 810 ctrls->error_idx = i; 811 return err; 812 } 813 } 814 if (set) 815 h->params = params; 816 return 0; 817} 818 819static int saa6752hs_s_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *ctrls) 820{ 821 return saa6752hs_do_ext_ctrls(sd, ctrls, 1); 822} 823 824static int saa6752hs_try_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *ctrls) 825{ 826 return saa6752hs_do_ext_ctrls(sd, ctrls, 0); 827} 828 829static int saa6752hs_g_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *ctrls) 830{ 831 struct saa6752hs_state *h = to_state(sd); 832 int i; 833 834 if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG) 835 return -EINVAL; 836 837 for (i = 0; i < ctrls->count; i++) { 838 int err = get_ctrl(h->has_ac3, &h->params, ctrls->controls + i); 839 840 if (err) { 841 ctrls->error_idx = i; 842 return err; 843 } 844 } 845 return 0; 846} 847 848static int saa6752hs_g_mbus_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *f) 849{ 850 struct saa6752hs_state *h = to_state(sd); 851 852 if (h->video_format == SAA6752HS_VF_UNKNOWN) 853 h->video_format = SAA6752HS_VF_D1; 854 f->width = v4l2_format_table[h->video_format].fmt.pix.width; 855 f->height = v4l2_format_table[h->video_format].fmt.pix.height; 856 f->code = V4L2_MBUS_FMT_FIXED; 857 f->field = V4L2_FIELD_INTERLACED; 858 f->colorspace = V4L2_COLORSPACE_SMPTE170M; 859 return 0; 860} 861 862static int saa6752hs_s_mbus_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *f) 863{ 864 struct saa6752hs_state *h = to_state(sd); 865 int dist_352, dist_480, dist_720; 866 867 if (f->code != V4L2_MBUS_FMT_FIXED) 868 return -EINVAL; 869 870 /* 871 FIXME: translate and round width/height into EMPRESS 872 subsample type: 873 874 type | PAL | NTSC 875 --------------------------- 876 SIF | 352x288 | 352x240 877 1/2 D1 | 352x576 | 352x480 878 2/3 D1 | 480x576 | 480x480 879 D1 | 720x576 | 720x480 880 */ 881 882 dist_352 = abs(f->width - 352); 883 dist_480 = abs(f->width - 480); 884 dist_720 = abs(f->width - 720); 885 if (dist_720 < dist_480) { 886 f->width = 720; 887 f->height = 576; 888 h->video_format = SAA6752HS_VF_D1; 889 } else if (dist_480 < dist_352) { 890 f->width = 480; 891 f->height = 576; 892 h->video_format = SAA6752HS_VF_2_3_D1; 893 } else { 894 f->width = 352; 895 if (abs(f->height - 576) < 896 abs(f->height - 288)) { 897 f->height = 576; 898 h->video_format = SAA6752HS_VF_1_2_D1; 899 } else { 900 f->height = 288; 901 h->video_format = SAA6752HS_VF_SIF; 902 } 903 } 904 f->field = V4L2_FIELD_INTERLACED; 905 f->colorspace = V4L2_COLORSPACE_SMPTE170M; 906 return 0; 907} 908 909static int saa6752hs_s_std(struct v4l2_subdev *sd, v4l2_std_id std) 910{ 911 struct saa6752hs_state *h = to_state(sd); 912 913 h->standard = std; 914 return 0; 915} 916 917static int saa6752hs_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip) 918{ 919 struct i2c_client *client = v4l2_get_subdevdata(sd); 920 struct saa6752hs_state *h = to_state(sd); 921 922 return v4l2_chip_ident_i2c_client(client, 923 chip, h->chip, h->revision); 924} 925 926/* ----------------------------------------------------------------------- */ 927 928static const struct v4l2_subdev_core_ops saa6752hs_core_ops = { 929 .g_chip_ident = saa6752hs_g_chip_ident, 930 .init = saa6752hs_init, 931 .queryctrl = saa6752hs_queryctrl, 932 .querymenu = saa6752hs_querymenu, 933 .g_ext_ctrls = saa6752hs_g_ext_ctrls, 934 .s_ext_ctrls = saa6752hs_s_ext_ctrls, 935 .try_ext_ctrls = saa6752hs_try_ext_ctrls, 936 .s_std = saa6752hs_s_std, 937}; 938 939static const struct v4l2_subdev_video_ops saa6752hs_video_ops = { 940 .s_mbus_fmt = saa6752hs_s_mbus_fmt, 941 .g_mbus_fmt = saa6752hs_g_mbus_fmt, 942}; 943 944static const struct v4l2_subdev_ops saa6752hs_ops = { 945 .core = &saa6752hs_core_ops, 946 .video = &saa6752hs_video_ops, 947}; 948 949static int saa6752hs_probe(struct i2c_client *client, 950 const struct i2c_device_id *id) 951{ 952 struct saa6752hs_state *h = kzalloc(sizeof(*h), GFP_KERNEL); 953 struct v4l2_subdev *sd; 954 u8 addr = 0x13; 955 u8 data[12]; 956 957 v4l_info(client, "chip found @ 0x%x (%s)\n", 958 client->addr << 1, client->adapter->name); 959 if (h == NULL) 960 return -ENOMEM; 961 sd = &h->sd; 962 v4l2_i2c_subdev_init(sd, client, &saa6752hs_ops); 963 964 i2c_master_send(client, &addr, 1); 965 i2c_master_recv(client, data, sizeof(data)); 966 h->chip = V4L2_IDENT_SAA6752HS; 967 h->revision = (data[8] << 8) | data[9]; 968 h->has_ac3 = 0; 969 if (h->revision == 0x0206) { 970 h->chip = V4L2_IDENT_SAA6752HS_AC3; 971 h->has_ac3 = 1; 972 v4l_info(client, "support AC-3\n"); 973 } 974 h->params = param_defaults; 975 h->standard = 0; /* Assume 625 input lines */ 976 return 0; 977} 978 979static int saa6752hs_remove(struct i2c_client *client) 980{ 981 struct v4l2_subdev *sd = i2c_get_clientdata(client); 982 983 v4l2_device_unregister_subdev(sd); 984 kfree(to_state(sd)); 985 return 0; 986} 987 988static const struct i2c_device_id saa6752hs_id[] = { 989 { "saa6752hs", 0 }, 990 { } 991}; 992MODULE_DEVICE_TABLE(i2c, saa6752hs_id); 993 994static struct i2c_driver saa6752hs_driver = { 995 .driver = { 996 .owner = THIS_MODULE, 997 .name = "saa6752hs", 998 }, 999 .probe = saa6752hs_probe, 1000 .remove = saa6752hs_remove, 1001 .id_table = saa6752hs_id, 1002}; 1003 1004module_i2c_driver(saa6752hs_driver); 1005 1006/* 1007 * Overrides for Emacs so that we follow Linus's tabbing style. 1008 * --------------------------------------------------------------------------- 1009 * Local variables: 1010 * c-basic-offset: 8 1011 * End: 1012 */ 1013