0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027 #include "ch7006_priv.h"
0028
0029 const char * const ch7006_tv_norm_names[] = {
0030 [TV_NORM_PAL] = "PAL",
0031 [TV_NORM_PAL_M] = "PAL-M",
0032 [TV_NORM_PAL_N] = "PAL-N",
0033 [TV_NORM_PAL_NC] = "PAL-Nc",
0034 [TV_NORM_PAL_60] = "PAL-60",
0035 [TV_NORM_NTSC_M] = "NTSC-M",
0036 [TV_NORM_NTSC_J] = "NTSC-J",
0037 };
0038
0039 #define NTSC_LIKE_TIMINGS .vrefresh = 60 * fixed1/1.001, \
0040 .vdisplay = 480, \
0041 .vtotal = 525, \
0042 .hvirtual = 660
0043
0044 #define PAL_LIKE_TIMINGS .vrefresh = 50 * fixed1, \
0045 .vdisplay = 576, \
0046 .vtotal = 625, \
0047 .hvirtual = 810
0048
0049 const struct ch7006_tv_norm_info ch7006_tv_norms[] = {
0050 [TV_NORM_NTSC_M] = {
0051 NTSC_LIKE_TIMINGS,
0052 .black_level = 0.339 * fixed1,
0053 .subc_freq = 3579545 * fixed1,
0054 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, NTSC),
0055 .voffset = 0,
0056 },
0057 [TV_NORM_NTSC_J] = {
0058 NTSC_LIKE_TIMINGS,
0059 .black_level = 0.286 * fixed1,
0060 .subc_freq = 3579545 * fixed1,
0061 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, NTSC_J),
0062 .voffset = 0,
0063 },
0064 [TV_NORM_PAL] = {
0065 PAL_LIKE_TIMINGS,
0066 .black_level = 0.3 * fixed1,
0067 .subc_freq = 4433618.75 * fixed1,
0068 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, PAL),
0069 .voffset = 0,
0070 },
0071 [TV_NORM_PAL_M] = {
0072 NTSC_LIKE_TIMINGS,
0073 .black_level = 0.339 * fixed1,
0074 .subc_freq = 3575611.433 * fixed1,
0075 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, PAL_M),
0076 .voffset = 16,
0077 },
0078
0079
0080
0081
0082 [TV_NORM_PAL_N] = {
0083 PAL_LIKE_TIMINGS,
0084 .black_level = 0.339 * fixed1,
0085 .subc_freq = 4433618.75 * fixed1,
0086 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, PAL),
0087 .voffset = 0,
0088 },
0089 [TV_NORM_PAL_NC] = {
0090 PAL_LIKE_TIMINGS,
0091 .black_level = 0.3 * fixed1,
0092 .subc_freq = 3582056.25 * fixed1,
0093 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, PAL),
0094 .voffset = 0,
0095 },
0096 [TV_NORM_PAL_60] = {
0097 NTSC_LIKE_TIMINGS,
0098 .black_level = 0.3 * fixed1,
0099 .subc_freq = 4433618.75 * fixed1,
0100 .dispmode = bitfs(CH7006_DISPMODE_OUTPUT_STD, PAL_M),
0101 .voffset = 16,
0102 },
0103 };
0104
0105 #define __MODE(f, hd, vd, ht, vt, hsynp, vsynp, \
0106 subc, scale, scale_mask, norm_mask, e_hd, e_vd) { \
0107 .mode = { \
0108 .name = #hd "x" #vd, \
0109 .status = 0, \
0110 .type = DRM_MODE_TYPE_DRIVER, \
0111 .clock = f, \
0112 .hdisplay = hd, \
0113 .hsync_start = e_hd + 16, \
0114 .hsync_end = e_hd + 80, \
0115 .htotal = ht, \
0116 .hskew = 0, \
0117 .vdisplay = vd, \
0118 .vsync_start = vd + 10, \
0119 .vsync_end = vd + 26, \
0120 .vtotal = vt, \
0121 .vscan = 0, \
0122 .flags = DRM_MODE_FLAG_##hsynp##HSYNC | \
0123 DRM_MODE_FLAG_##vsynp##VSYNC, \
0124 }, \
0125 .enc_hdisp = e_hd, \
0126 .enc_vdisp = e_vd, \
0127 .subc_coeff = subc * fixed1, \
0128 .dispmode = bitfs(CH7006_DISPMODE_SCALING_RATIO, scale) | \
0129 bitfs(CH7006_DISPMODE_INPUT_RES, e_hd##x##e_vd), \
0130 .valid_scales = scale_mask, \
0131 .valid_norms = norm_mask \
0132 }
0133
0134 #define MODE(f, hd, vd, ht, vt, hsynp, vsynp, \
0135 subc, scale, scale_mask, norm_mask) \
0136 __MODE(f, hd, vd, ht, vt, hsynp, vsynp, subc, scale, \
0137 scale_mask, norm_mask, hd, vd)
0138
0139 #define NTSC_LIKE (1 << TV_NORM_NTSC_M | 1 << TV_NORM_NTSC_J | \
0140 1 << TV_NORM_PAL_M | 1 << TV_NORM_PAL_60)
0141
0142 #define PAL_LIKE (1 << TV_NORM_PAL | 1 << TV_NORM_PAL_N | 1 << TV_NORM_PAL_NC)
0143
0144 const struct ch7006_mode ch7006_modes[] = {
0145 MODE(21000, 512, 384, 840, 500, N, N, 181.797557582, 5_4, 0x6, PAL_LIKE),
0146 MODE(26250, 512, 384, 840, 625, N, N, 145.438046066, 1_1, 0x1, PAL_LIKE),
0147 MODE(20140, 512, 384, 800, 420, N, N, 213.257083791, 5_4, 0x4, NTSC_LIKE),
0148 MODE(24671, 512, 384, 784, 525, N, N, 174.0874153, 1_1, 0x3, NTSC_LIKE),
0149 MODE(28125, 720, 400, 1125, 500, N, N, 135.742176298, 5_4, 0x6, PAL_LIKE),
0150 MODE(34875, 720, 400, 1116, 625, N, N, 109.469496898, 1_1, 0x1, PAL_LIKE),
0151 MODE(23790, 720, 400, 945, 420, N, N, 160.475642016, 5_4, 0x4, NTSC_LIKE),
0152 MODE(29455, 720, 400, 936, 525, N, N, 129.614941843, 1_1, 0x3, NTSC_LIKE),
0153 MODE(25000, 640, 400, 1000, 500, N, N, 152.709948279, 5_4, 0x6, PAL_LIKE),
0154 MODE(31500, 640, 400, 1008, 625, N, N, 121.198371646, 1_1, 0x1, PAL_LIKE),
0155 MODE(21147, 640, 400, 840, 420, N, N, 180.535097338, 5_4, 0x4, NTSC_LIKE),
0156 MODE(26434, 640, 400, 840, 525, N, N, 144.42807787, 1_1, 0x2, NTSC_LIKE),
0157 MODE(30210, 640, 400, 840, 600, N, N, 126.374568276, 7_8, 0x1, NTSC_LIKE),
0158 MODE(21000, 640, 480, 840, 500, N, N, 181.797557582, 5_4, 0x4, PAL_LIKE),
0159 MODE(26250, 640, 480, 840, 625, N, N, 145.438046066, 1_1, 0x2, PAL_LIKE),
0160 MODE(31500, 640, 480, 840, 750, N, N, 121.198371646, 5_6, 0x1, PAL_LIKE),
0161 MODE(24671, 640, 480, 784, 525, N, N, 174.0874153, 1_1, 0x4, NTSC_LIKE),
0162 MODE(28196, 640, 480, 784, 600, N, N, 152.326488422, 7_8, 0x2, NTSC_LIKE),
0163 MODE(30210, 640, 480, 800, 630, N, N, 142.171389101, 5_6, 0x1, NTSC_LIKE),
0164 __MODE(29500, 720, 576, 944, 625, P, P, 145.592111636, 1_1, 0x7, PAL_LIKE, 800, 600),
0165 MODE(36000, 800, 600, 960, 750, P, P, 119.304647022, 5_6, 0x6, PAL_LIKE),
0166 MODE(39000, 800, 600, 936, 836, P, P, 110.127366499, 3_4, 0x1, PAL_LIKE),
0167 MODE(39273, 800, 600, 1040, 630, P, P, 145.816809399, 5_6, 0x4, NTSC_LIKE),
0168 MODE(43636, 800, 600, 1040, 700, P, P, 131.235128487, 3_4, 0x2, NTSC_LIKE),
0169 MODE(47832, 800, 600, 1064, 750, P, P, 119.723275165, 7_10, 0x1, NTSC_LIKE),
0170 {}
0171 };
0172
0173 const struct ch7006_mode *ch7006_lookup_mode(struct drm_encoder *encoder,
0174 const struct drm_display_mode *drm_mode)
0175 {
0176 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0177 const struct ch7006_mode *mode;
0178
0179 for (mode = ch7006_modes; mode->mode.clock; mode++) {
0180
0181 if (~mode->valid_norms & 1<<priv->norm)
0182 continue;
0183
0184 if (mode->mode.hdisplay != drm_mode->hdisplay ||
0185 mode->mode.vdisplay != drm_mode->vdisplay ||
0186 mode->mode.vtotal != drm_mode->vtotal ||
0187 mode->mode.htotal != drm_mode->htotal ||
0188 mode->mode.clock != drm_mode->clock)
0189 continue;
0190
0191 return mode;
0192 }
0193
0194 return NULL;
0195 }
0196
0197
0198
0199 void ch7006_setup_levels(struct drm_encoder *encoder)
0200 {
0201 struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
0202 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0203 uint8_t *regs = priv->state.regs;
0204 const struct ch7006_tv_norm_info *norm = &ch7006_tv_norms[priv->norm];
0205 int gain;
0206 int black_level;
0207
0208
0209
0210 if (norm->black_level < 339*fixed1/1000) {
0211 gain = 76;
0212
0213 regs[CH7006_INPUT_FORMAT] |= CH7006_INPUT_FORMAT_DAC_GAIN;
0214 } else {
0215 gain = 71;
0216
0217 regs[CH7006_INPUT_FORMAT] &= ~CH7006_INPUT_FORMAT_DAC_GAIN;
0218 }
0219
0220 black_level = round_fixed(norm->black_level*26625)/gain;
0221
0222
0223 black_level = interpolate(90, black_level, 208, priv->brightness);
0224
0225 regs[CH7006_BLACK_LEVEL] = bitf(CH7006_BLACK_LEVEL_0, black_level);
0226
0227 ch7006_dbg(client, "black level: %d\n", black_level);
0228 }
0229
0230 void ch7006_setup_subcarrier(struct drm_encoder *encoder)
0231 {
0232 struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
0233 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0234 struct ch7006_state *state = &priv->state;
0235 const struct ch7006_tv_norm_info *norm = &ch7006_tv_norms[priv->norm];
0236 const struct ch7006_mode *mode = priv->mode;
0237 uint32_t subc_inc;
0238
0239 subc_inc = round_fixed((mode->subc_coeff >> 8)
0240 * (norm->subc_freq >> 24));
0241
0242 setbitf(state, CH7006_SUBC_INC0, 28, subc_inc);
0243 setbitf(state, CH7006_SUBC_INC1, 24, subc_inc);
0244 setbitf(state, CH7006_SUBC_INC2, 20, subc_inc);
0245 setbitf(state, CH7006_SUBC_INC3, 16, subc_inc);
0246 setbitf(state, CH7006_SUBC_INC4, 12, subc_inc);
0247 setbitf(state, CH7006_SUBC_INC5, 8, subc_inc);
0248 setbitf(state, CH7006_SUBC_INC6, 4, subc_inc);
0249 setbitf(state, CH7006_SUBC_INC7, 0, subc_inc);
0250
0251 ch7006_dbg(client, "subcarrier inc: %u\n", subc_inc);
0252 }
0253
0254 void ch7006_setup_pll(struct drm_encoder *encoder)
0255 {
0256 struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
0257 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0258 uint8_t *regs = priv->state.regs;
0259 const struct ch7006_mode *mode = priv->mode;
0260 int n, best_n = 0;
0261 int m, best_m = 0;
0262 int freq, best_freq = 0;
0263
0264 for (n = 0; n < CH7006_MAXN; n++) {
0265 for (m = 0; m < CH7006_MAXM; m++) {
0266 freq = CH7006_FREQ0*(n+2)/(m+2);
0267
0268 if (abs(freq - mode->mode.clock) <
0269 abs(best_freq - mode->mode.clock)) {
0270 best_freq = freq;
0271 best_n = n;
0272 best_m = m;
0273 }
0274 }
0275 }
0276
0277 regs[CH7006_PLLOV] = bitf(CH7006_PLLOV_N_8, best_n) |
0278 bitf(CH7006_PLLOV_M_8, best_m);
0279
0280 regs[CH7006_PLLM] = bitf(CH7006_PLLM_0, best_m);
0281 regs[CH7006_PLLN] = bitf(CH7006_PLLN_0, best_n);
0282
0283 if (best_n < 108)
0284 regs[CH7006_PLL_CONTROL] |= CH7006_PLL_CONTROL_CAPACITOR;
0285 else
0286 regs[CH7006_PLL_CONTROL] &= ~CH7006_PLL_CONTROL_CAPACITOR;
0287
0288 ch7006_dbg(client, "n=%d m=%d f=%d c=%d\n",
0289 best_n, best_m, best_freq, best_n < 108);
0290 }
0291
0292 void ch7006_setup_power_state(struct drm_encoder *encoder)
0293 {
0294 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0295 uint8_t *power = &priv->state.regs[CH7006_POWER];
0296 int subconnector;
0297
0298 subconnector = priv->select_subconnector ? priv->select_subconnector :
0299 priv->subconnector;
0300
0301 *power = CH7006_POWER_RESET;
0302
0303 if (priv->last_dpms == DRM_MODE_DPMS_ON) {
0304 switch (subconnector) {
0305 case DRM_MODE_SUBCONNECTOR_SVIDEO:
0306 *power |= bitfs(CH7006_POWER_LEVEL, CVBS_OFF);
0307 break;
0308 case DRM_MODE_SUBCONNECTOR_Composite:
0309 *power |= bitfs(CH7006_POWER_LEVEL, SVIDEO_OFF);
0310 break;
0311 case DRM_MODE_SUBCONNECTOR_SCART:
0312 *power |= bitfs(CH7006_POWER_LEVEL, NORMAL) |
0313 CH7006_POWER_SCART;
0314 break;
0315 }
0316
0317 } else {
0318 if (priv->chip_version >= 0x20)
0319 *power |= bitfs(CH7006_POWER_LEVEL, FULL_POWER_OFF);
0320 else
0321 *power |= bitfs(CH7006_POWER_LEVEL, POWER_OFF);
0322 }
0323 }
0324
0325 void ch7006_setup_properties(struct drm_encoder *encoder)
0326 {
0327 struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
0328 struct ch7006_priv *priv = to_ch7006_priv(encoder);
0329 struct ch7006_state *state = &priv->state;
0330 const struct ch7006_tv_norm_info *norm = &ch7006_tv_norms[priv->norm];
0331 const struct ch7006_mode *ch_mode = priv->mode;
0332 const struct drm_display_mode *mode = &ch_mode->mode;
0333 uint8_t *regs = state->regs;
0334 int flicker, contrast, hpos, vpos;
0335 uint64_t scale, aspect;
0336
0337 flicker = interpolate(0, 2, 3, priv->flicker);
0338 regs[CH7006_FFILTER] = bitf(CH7006_FFILTER_TEXT, flicker) |
0339 bitf(CH7006_FFILTER_LUMA, flicker) |
0340 bitf(CH7006_FFILTER_CHROMA, 1);
0341
0342 contrast = interpolate(0, 5, 7, priv->contrast);
0343 regs[CH7006_CONTRAST] = bitf(CH7006_CONTRAST_0, contrast);
0344
0345 scale = norm->vtotal*fixed1;
0346 do_div(scale, mode->vtotal);
0347
0348 aspect = ch_mode->enc_hdisp*fixed1;
0349 do_div(aspect, ch_mode->enc_vdisp);
0350
0351 hpos = round_fixed((norm->hvirtual * aspect - mode->hdisplay * scale)
0352 * priv->hmargin * mode->vtotal) / norm->vtotal / 100 / 4;
0353
0354 setbitf(state, CH7006_POV, HPOS_8, hpos);
0355 setbitf(state, CH7006_HPOS, 0, hpos);
0356
0357 vpos = max(0, norm->vdisplay - round_fixed(mode->vdisplay*scale)
0358 + norm->voffset) * priv->vmargin / 100 / 2;
0359
0360 setbitf(state, CH7006_POV, VPOS_8, vpos);
0361 setbitf(state, CH7006_VPOS, 0, vpos);
0362
0363 ch7006_dbg(client, "hpos: %d, vpos: %d\n", hpos, vpos);
0364 }
0365
0366
0367
0368 void ch7006_write(struct i2c_client *client, uint8_t addr, uint8_t val)
0369 {
0370 uint8_t buf[] = {addr, val};
0371 int ret;
0372
0373 ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
0374 if (ret < 0)
0375 ch7006_err(client, "Error %d writing to subaddress 0x%x\n",
0376 ret, addr);
0377 }
0378
0379 uint8_t ch7006_read(struct i2c_client *client, uint8_t addr)
0380 {
0381 uint8_t val;
0382 int ret;
0383
0384 ret = i2c_master_send(client, &addr, sizeof(addr));
0385 if (ret < 0)
0386 goto fail;
0387
0388 ret = i2c_master_recv(client, &val, sizeof(val));
0389 if (ret < 0)
0390 goto fail;
0391
0392 return val;
0393
0394 fail:
0395 ch7006_err(client, "Error %d reading from subaddress 0x%x\n",
0396 ret, addr);
0397 return 0;
0398 }
0399
0400 void ch7006_state_load(struct i2c_client *client,
0401 struct ch7006_state *state)
0402 {
0403 ch7006_load_reg(client, state, CH7006_POWER);
0404
0405 ch7006_load_reg(client, state, CH7006_DISPMODE);
0406 ch7006_load_reg(client, state, CH7006_FFILTER);
0407 ch7006_load_reg(client, state, CH7006_BWIDTH);
0408 ch7006_load_reg(client, state, CH7006_INPUT_FORMAT);
0409 ch7006_load_reg(client, state, CH7006_CLKMODE);
0410 ch7006_load_reg(client, state, CH7006_START_ACTIVE);
0411 ch7006_load_reg(client, state, CH7006_POV);
0412 ch7006_load_reg(client, state, CH7006_BLACK_LEVEL);
0413 ch7006_load_reg(client, state, CH7006_HPOS);
0414 ch7006_load_reg(client, state, CH7006_VPOS);
0415 ch7006_load_reg(client, state, CH7006_INPUT_SYNC);
0416 ch7006_load_reg(client, state, CH7006_DETECT);
0417 ch7006_load_reg(client, state, CH7006_CONTRAST);
0418 ch7006_load_reg(client, state, CH7006_PLLOV);
0419 ch7006_load_reg(client, state, CH7006_PLLM);
0420 ch7006_load_reg(client, state, CH7006_PLLN);
0421 ch7006_load_reg(client, state, CH7006_BCLKOUT);
0422 ch7006_load_reg(client, state, CH7006_SUBC_INC0);
0423 ch7006_load_reg(client, state, CH7006_SUBC_INC1);
0424 ch7006_load_reg(client, state, CH7006_SUBC_INC2);
0425 ch7006_load_reg(client, state, CH7006_SUBC_INC3);
0426 ch7006_load_reg(client, state, CH7006_SUBC_INC4);
0427 ch7006_load_reg(client, state, CH7006_SUBC_INC5);
0428 ch7006_load_reg(client, state, CH7006_SUBC_INC6);
0429 ch7006_load_reg(client, state, CH7006_SUBC_INC7);
0430 ch7006_load_reg(client, state, CH7006_PLL_CONTROL);
0431 ch7006_load_reg(client, state, CH7006_CALC_SUBC_INC0);
0432 }
0433
0434 void ch7006_state_save(struct i2c_client *client,
0435 struct ch7006_state *state)
0436 {
0437 ch7006_save_reg(client, state, CH7006_POWER);
0438
0439 ch7006_save_reg(client, state, CH7006_DISPMODE);
0440 ch7006_save_reg(client, state, CH7006_FFILTER);
0441 ch7006_save_reg(client, state, CH7006_BWIDTH);
0442 ch7006_save_reg(client, state, CH7006_INPUT_FORMAT);
0443 ch7006_save_reg(client, state, CH7006_CLKMODE);
0444 ch7006_save_reg(client, state, CH7006_START_ACTIVE);
0445 ch7006_save_reg(client, state, CH7006_POV);
0446 ch7006_save_reg(client, state, CH7006_BLACK_LEVEL);
0447 ch7006_save_reg(client, state, CH7006_HPOS);
0448 ch7006_save_reg(client, state, CH7006_VPOS);
0449 ch7006_save_reg(client, state, CH7006_INPUT_SYNC);
0450 ch7006_save_reg(client, state, CH7006_DETECT);
0451 ch7006_save_reg(client, state, CH7006_CONTRAST);
0452 ch7006_save_reg(client, state, CH7006_PLLOV);
0453 ch7006_save_reg(client, state, CH7006_PLLM);
0454 ch7006_save_reg(client, state, CH7006_PLLN);
0455 ch7006_save_reg(client, state, CH7006_BCLKOUT);
0456 ch7006_save_reg(client, state, CH7006_SUBC_INC0);
0457 ch7006_save_reg(client, state, CH7006_SUBC_INC1);
0458 ch7006_save_reg(client, state, CH7006_SUBC_INC2);
0459 ch7006_save_reg(client, state, CH7006_SUBC_INC3);
0460 ch7006_save_reg(client, state, CH7006_SUBC_INC4);
0461 ch7006_save_reg(client, state, CH7006_SUBC_INC5);
0462 ch7006_save_reg(client, state, CH7006_SUBC_INC6);
0463 ch7006_save_reg(client, state, CH7006_SUBC_INC7);
0464 ch7006_save_reg(client, state, CH7006_PLL_CONTROL);
0465 ch7006_save_reg(client, state, CH7006_CALC_SUBC_INC0);
0466
0467 state->regs[CH7006_FFILTER] = (state->regs[CH7006_FFILTER] & 0xf0) |
0468 (state->regs[CH7006_FFILTER] & 0x0c) >> 2 |
0469 (state->regs[CH7006_FFILTER] & 0x03) << 2;
0470 }