?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[wrt350n-kernel.git] / drivers / video / matrox / matroxfb_maven.c
blob0cd58f84fb464170ada3264bfca5500e1dc634c9
1 /*
2 *
3 * Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200, G400 and G450.
4 *
5 * (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz>
6 *
7 * Portions Copyright (c) 2001 Matrox Graphics Inc.
8 *
9 * Version: 1.65 2002/08/14
10 *
11 * See matroxfb_base.c for contributors.
12 *
13 */
14
15 #include "matroxfb_maven.h"
16 #include "matroxfb_misc.h"
17 #include "matroxfb_DAC1064.h"
18 #include <linux/i2c.h>
19 #include <linux/matroxfb.h>
20 #include <asm/div64.h>
21
22 #define MAVEN_I2CID (0x1B)
23
24 #define MGATVO_B 1
25 #define MGATVO_C 2
26
27 static const struct maven_gamma {
28 unsigned char reg83;
29 unsigned char reg84;
30 unsigned char reg85;
31 unsigned char reg86;
32 unsigned char reg87;
33 unsigned char reg88;
34 unsigned char reg89;
35 unsigned char reg8a;
36 unsigned char reg8b;
37 } maven_gamma[] = {
38 { 131, 57, 223, 15, 117, 212, 251, 91, 156},
39 { 133, 61, 128, 63, 180, 147, 195, 100, 180},
40 { 131, 19, 63, 31, 50, 66, 171, 64, 176},
41 { 0, 0, 0, 31, 16, 16, 16, 100, 200},
42 { 8, 23, 47, 73, 147, 244, 220, 80, 195},
43 { 22, 43, 64, 80, 147, 115, 58, 85, 168},
44 { 34, 60, 80, 214, 147, 212, 188, 85, 167},
45 { 45, 77, 96, 216, 147, 99, 91, 85, 159},
46 { 56, 76, 112, 107, 147, 212, 148, 64, 144},
47 { 65, 91, 128, 137, 147, 196, 17, 69, 148},
48 { 72, 104, 136, 138, 147, 180, 245, 73, 147},
49 { 87, 116, 143, 126, 16, 83, 229, 77, 144},
50 { 95, 119, 152, 254, 244, 83, 221, 77, 151},
51 { 100, 129, 159, 156, 244, 148, 197, 77, 160},
52 { 105, 141, 167, 247, 244, 132, 181, 84, 166},
53 { 105, 147, 168, 247, 244, 245, 181, 90, 170},
54 { 120, 153, 175, 248, 212, 229, 165, 90, 180},
55 { 119, 156, 176, 248, 244, 229, 84, 74, 160},
56 { 119, 158, 183, 248, 244, 229, 149, 78, 165}
57 };
58
59 /* Definition of the various controls */
60 struct mctl {
61 struct v4l2_queryctrl desc;
62 size_t control;
63 };
64
65 #define BLMIN 0x0FF
66 #define WLMAX 0x3FF
67
68 static const struct mctl maven_controls[] =
69 { { { V4L2_CID_BRIGHTNESS, V4L2_CTRL_TYPE_INTEGER,
70 "brightness",
71 0, WLMAX - BLMIN, 1, 379 - BLMIN,
72 0,
73 }, offsetof(struct matrox_fb_info, altout.tvo_params.brightness) },
74 { { V4L2_CID_CONTRAST, V4L2_CTRL_TYPE_INTEGER,
75 "contrast",
76 0, 1023, 1, 127,
77 0,
78 }, offsetof(struct matrox_fb_info, altout.tvo_params.contrast) },
79 { { V4L2_CID_SATURATION, V4L2_CTRL_TYPE_INTEGER,
80 "saturation",
81 0, 255, 1, 155,
82 0,
83 }, offsetof(struct matrox_fb_info, altout.tvo_params.saturation) },
84 { { V4L2_CID_HUE, V4L2_CTRL_TYPE_INTEGER,
85 "hue",
86 0, 255, 1, 0,
87 0,
88 }, offsetof(struct matrox_fb_info, altout.tvo_params.hue) },
89 { { V4L2_CID_GAMMA, V4L2_CTRL_TYPE_INTEGER,
90 "gamma",
91 0, ARRAY_SIZE(maven_gamma) - 1, 1, 3,
92 0,
93 }, offsetof(struct matrox_fb_info, altout.tvo_params.gamma) },
94 { { MATROXFB_CID_TESTOUT, V4L2_CTRL_TYPE_BOOLEAN,
95 "test output",
96 0, 1, 1, 0,
97 0,
98 }, offsetof(struct matrox_fb_info, altout.tvo_params.testout) },
99 { { MATROXFB_CID_DEFLICKER, V4L2_CTRL_TYPE_INTEGER,
100 "deflicker mode",
101 0, 2, 1, 0,
102 0,
103 }, offsetof(struct matrox_fb_info, altout.tvo_params.deflicker) },
104
105 };
106
107 #define MAVCTRLS ARRAY_SIZE(maven_controls)
108
109 /* Return: positive number: id found
110 -EINVAL: id not found, return failure
111 -ENOENT: id not found, create fake disabled control */
112 static int get_ctrl_id(__u32 v4l2_id) {
113 int i;
114
115 for (i = 0; i < MAVCTRLS; i++) {
116 if (v4l2_id < maven_controls[i].desc.id) {
117 if (maven_controls[i].desc.id == 0x08000000) {
118 return -EINVAL;
119 }
120 return -ENOENT;
121 }
122 if (v4l2_id == maven_controls[i].desc.id) {
123 return i;
124 }
125 }
126 return -EINVAL;
127 }
128
129 struct maven_data {
130 struct matrox_fb_info* primary_head;
131 struct i2c_client client;
132 int version;
133 };
134
135 static int* get_ctrl_ptr(struct maven_data* md, int idx) {
136 return (int*)((char*)(md->primary_head) + maven_controls[idx].control);
137 }
138
139 static int maven_get_reg(struct i2c_client* c, char reg) {
140 char dst;
141 struct i2c_msg msgs[] = {{ c->addr, I2C_M_REV_DIR_ADDR, sizeof(reg), &reg },
142 { c->addr, I2C_M_RD | I2C_M_NOSTART, sizeof(dst), &dst }};
143 s32 err;
144
145 err = i2c_transfer(c->adapter, msgs, 2);
146 if (err < 0)
147 printk(KERN_INFO "ReadReg(%d) failed\n", reg);
148 return dst & 0xFF;
149 }
150
151 static int maven_set_reg(struct i2c_client* c, int reg, int val) {
152 s32 err;
153
154 err = i2c_smbus_write_byte_data(c, reg, val);
155 if (err)
156 printk(KERN_INFO "WriteReg(%d) failed\n", reg);
157 return err;
158 }
159
160 static int maven_set_reg_pair(struct i2c_client* c, int reg, int val) {
161 s32 err;
162
163 err = i2c_smbus_write_word_data(c, reg, val);
164 if (err)
165 printk(KERN_INFO "WriteRegPair(%d) failed\n", reg);
166 return err;
167 }
168
169 static const struct matrox_pll_features maven_pll = {
170 50000,
171 27000,
172 4, 127,
173 2, 31,
174 3
175 };
176
177 struct matrox_pll_features2 {
178 unsigned int vco_freq_min;
179 unsigned int vco_freq_max;
180 unsigned int feed_div_min;
181 unsigned int feed_div_max;
182 unsigned int in_div_min;
183 unsigned int in_div_max;
184 unsigned int post_shift_max;
185 };
186
187 struct matrox_pll_ctl {
188 unsigned int ref_freq;
189 unsigned int den;
190 };
191
192 static const struct matrox_pll_features2 maven1000_pll = {
193 50000000,
194 300000000,
195 5, 128,
196 3, 32,
197 3
198 };
199
200 static const struct matrox_pll_ctl maven_PAL = {
201 540000,
202 50
203 };
204
205 static const struct matrox_pll_ctl maven_NTSC = {
206 450450, /* 27027000/60 == 27000000/59.94005994 */
207 60
208 };
209
210 static int matroxfb_PLL_mavenclock(const struct matrox_pll_features2* pll,
211 const struct matrox_pll_ctl* ctl,
212 unsigned int htotal, unsigned int vtotal,
213 unsigned int* in, unsigned int* feed, unsigned int* post,
214 unsigned int* h2) {
215 unsigned int besth2 = 0;
216 unsigned int fxtal = ctl->ref_freq;
217 unsigned int fmin = pll->vco_freq_min / ctl->den;
218 unsigned int fwant;
219 unsigned int p;
220 unsigned int scrlen;
221 unsigned int fmax;
222
223 DBG(__FUNCTION__)
224
225 scrlen = htotal * (vtotal - 1);
226 fwant = htotal * vtotal;
227 fmax = pll->vco_freq_max / ctl->den;
228
229 dprintk(KERN_DEBUG "want: %u, xtal: %u, h: %u, v: %u, fmax: %u\n",
230 fwant, fxtal, htotal, vtotal, fmax);
231 for (p = 1; p <= pll->post_shift_max; p++) {
232 if (fwant * 2 > fmax)
233 break;
234 fwant *= 2;
235 }
236 if (fwant > fmax)
237 return 0;
238 for (; p-- > 0; fwant >>= 1) {
239 unsigned int m;
240
241 if (fwant < fmin) break;
242 for (m = pll->in_div_min; m <= pll->in_div_max; m++) {
243 unsigned int n;
244 unsigned int dvd;
245 unsigned int ln;
246
247 n = (fwant * m) / fxtal;
248 if (n < pll->feed_div_min)
249 continue;
250 if (n > pll->feed_div_max)
251 break;
252
253 ln = fxtal * n;
254 dvd = m << p;
255
256 if (ln % dvd)
257 continue;
258 ln = ln / dvd;
259
260 if (ln < scrlen + 2)
261 continue;
262 ln = ln - scrlen;
263 if (ln > htotal)
264 continue;
265 dprintk(KERN_DEBUG "Match: %u / %u / %u / %u\n", n, m, p, ln);
266 if (ln > besth2) {
267 dprintk(KERN_DEBUG "Better...\n");
268 *h2 = besth2 = ln;
269 *post = p;
270 *in = m;
271 *feed = n;
272 }
273 }
274 }
275
276 /* if h2/post/in/feed have not been assigned, return zero (error) */
277 if (besth2 < 2)
278 return 0;
279
280 dprintk(KERN_ERR "clk: %02X %02X %02X %d %d\n", *in, *feed, *post, fxtal, fwant);
281 return fxtal * (*feed) / (*in) * ctl->den;
282 }
283
284 static unsigned int matroxfb_mavenclock(const struct matrox_pll_ctl* ctl,
285 unsigned int htotal, unsigned int vtotal,
286 unsigned int* in, unsigned int* feed, unsigned int* post,
287 unsigned int* htotal2) {
288 unsigned int fvco;
289 unsigned int uninitialized_var(p);
290
291 fvco = matroxfb_PLL_mavenclock(&maven1000_pll, ctl, htotal, vtotal, in, feed, &p, htotal2);
292 if (!fvco)
293 return -EINVAL;
294 p = (1 << p) - 1;
295 if (fvco <= 100000000)
296 ;
297 else if (fvco <= 140000000)
298 p |= 0x08;
299 else if (fvco <= 180000000)
300 p |= 0x10;
301 else
302 p |= 0x18;
303 *post = p;
304 return 0;
305 }
306
307 static void DAC1064_calcclock(unsigned int freq, unsigned int fmax,
308 unsigned int* in, unsigned int* feed, unsigned int* post) {
309 unsigned int fvco;
310 unsigned int p;
311
312 fvco = matroxfb_PLL_calcclock(&maven_pll, freq, fmax, in, feed, &p);
313 p = (1 << p) - 1;
314 if (fvco <= 100000)
315 ;
316 else if (fvco <= 140000)
317 p |= 0x08;
318 else if (fvco <= 180000)
319 p |= 0x10;
320 else
321 p |= 0x18;
322 *post = p;
323 return;
324 }
325
326 static unsigned char maven_compute_deflicker (const struct maven_data* md) {
327 unsigned char df;
328
329 df = (md->version == MGATVO_B?0x40:0x00);
330 switch (md->primary_head->altout.tvo_params.deflicker) {
331 case 0:
332 /* df |= 0x00; */
333 break;
334 case 1:
335 df |= 0xB1;
336 break;
337 case 2:
338 df |= 0xA2;
339 break;
340 }
341 return df;
342 }
343
344 static void maven_compute_bwlevel (const struct maven_data* md,
345 int *bl, int *wl) {
346 const int b = md->primary_head->altout.tvo_params.brightness + BLMIN;
347 const int c = md->primary_head->altout.tvo_params.contrast;
348
349 *bl = max(b - c, BLMIN);
350 *wl = min(b + c, WLMAX);
351 }
352
353 static const struct maven_gamma* maven_compute_gamma (const struct maven_data* md) {
354 return maven_gamma + md->primary_head->altout.tvo_params.gamma;
355 }
356
357
358 static void maven_init_TVdata(const struct maven_data* md, struct mavenregs* data) {
359 static struct mavenregs palregs = { {
360 0x2A, 0x09, 0x8A, 0xCB, /* 00: chroma subcarrier */
361 0x00,
362 0x00, /* ? not written */
363 0x00, /* modified by code (F9 written...) */
364 0x00, /* ? not written */
365 0x7E, /* 08 */
366 0x44, /* 09 */
367 0x9C, /* 0A */
368 0x2E, /* 0B */
369 0x21, /* 0C */
370 0x00, /* ? not written */
371 0x3F, 0x03, /* 0E-0F */
372 0x3F, 0x03, /* 10-11 */
373 0x1A, /* 12 */
374 0x2A, /* 13 */
375 0x1C, 0x3D, 0x14, /* 14-16 */
376 0x9C, 0x01, /* 17-18 */
377 0x00, /* 19 */
378 0xFE, /* 1A */
379 0x7E, /* 1B */
380 0x60, /* 1C */
381 0x05, /* 1D */
382 0x89, 0x03, /* 1E-1F */
383 0x72, /* 20 */
384 0x07, /* 21 */
385 0x72, /* 22 */
386 0x00, /* 23 */
387 0x00, /* 24 */
388 0x00, /* 25 */
389 0x08, /* 26 */
390 0x04, /* 27 */
391 0x00, /* 28 */
392 0x1A, /* 29 */
393 0x55, 0x01, /* 2A-2B */
394 0x26, /* 2C */
395 0x07, 0x7E, /* 2D-2E */
396 0x02, 0x54, /* 2F-30 */
397 0xB0, 0x00, /* 31-32 */
398 0x14, /* 33 */
399 0x49, /* 34 */
400 0x00, /* 35 written multiple times */
401 0x00, /* 36 not written */
402 0xA3, /* 37 */
403 0xC8, /* 38 */
404 0x22, /* 39 */
405 0x02, /* 3A */
406 0x22, /* 3B */
407 0x3F, 0x03, /* 3C-3D */
408 0x00, /* 3E written multiple times */
409 0x00, /* 3F not written */
410 }, MATROXFB_OUTPUT_MODE_PAL, 625, 50 };
411 static struct mavenregs ntscregs = { {
412 0x21, 0xF0, 0x7C, 0x1F, /* 00: chroma subcarrier */
413 0x00,
414 0x00, /* ? not written */
415 0x00, /* modified by code (F9 written...) */
416 0x00, /* ? not written */
417 0x7E, /* 08 */
418 0x43, /* 09 */
419 0x7E, /* 0A */
420 0x3D, /* 0B */
421 0x00, /* 0C */
422 0x00, /* ? not written */
423 0x41, 0x00, /* 0E-0F */
424 0x3C, 0x00, /* 10-11 */
425 0x17, /* 12 */
426 0x21, /* 13 */
427 0x1B, 0x1B, 0x24, /* 14-16 */
428 0x83, 0x01, /* 17-18 */
429 0x00, /* 19 */
430 0x0F, /* 1A */
431 0x0F, /* 1B */
432 0x60, /* 1C */
433 0x05, /* 1D */
434 0x89, 0x02, /* 1E-1F */
435 0x5F, /* 20 */
436 0x04, /* 21 */
437 0x5F, /* 22 */
438 0x01, /* 23 */
439 0x02, /* 24 */
440 0x00, /* 25 */
441 0x0A, /* 26 */
442 0x05, /* 27 */
443 0x00, /* 28 */
444 0x10, /* 29 */
445 0xFF, 0x03, /* 2A-2B */
446 0x24, /* 2C */
447 0x0F, 0x78, /* 2D-2E */
448 0x00, 0x00, /* 2F-30 */
449 0xB2, 0x04, /* 31-32 */
450 0x14, /* 33 */
451 0x02, /* 34 */
452 0x00, /* 35 written multiple times */
453 0x00, /* 36 not written */
454 0xA3, /* 37 */
455 0xC8, /* 38 */
456 0x15, /* 39 */
457 0x05, /* 3A */
458 0x3B, /* 3B */
459 0x3C, 0x00, /* 3C-3D */
460 0x00, /* 3E written multiple times */
461 0x00, /* never written */
462 }, MATROXFB_OUTPUT_MODE_NTSC, 525, 60 };
463 MINFO_FROM(md->primary_head);
464
465 if (ACCESS_FBINFO(outputs[1]).mode == MATROXFB_OUTPUT_MODE_PAL)
466 *data = palregs;
467 else
468 *data = ntscregs;
469
470 /* Set deflicker */
471 data->regs[0x93] = maven_compute_deflicker(md);
472
473 /* set gamma */
474 {
475 const struct maven_gamma* g;
476 g = maven_compute_gamma(md);
477 data->regs[0x83] = g->reg83;
478 data->regs[0x84] = g->reg84;
479 data->regs[0x85] = g->reg85;
480 data->regs[0x86] = g->reg86;
481 data->regs[0x87] = g->reg87;
482 data->regs[0x88] = g->reg88;
483 data->regs[0x89] = g->reg89;
484 data->regs[0x8A] = g->reg8a;
485 data->regs[0x8B] = g->reg8b;
486 }
487
488 /* Set contrast / brightness */
489 {
490 int bl, wl;
491 maven_compute_bwlevel (md, &bl, &wl);
492 data->regs[0x0e] = bl >> 2;
493 data->regs[0x0f] = bl & 3;
494 data->regs[0x1e] = wl >> 2;
495 data->regs[0x1f] = wl & 3;
496 }
497
498 /* Set saturation */
499 {
500 data->regs[0x20] =
501 data->regs[0x22] = ACCESS_FBINFO(altout.tvo_params.saturation);
502 }
503
504 /* Set HUE */
505 data->regs[0x25] = ACCESS_FBINFO(altout.tvo_params.hue);
506 return;
507 }
508
509 #define LR(x) maven_set_reg(c, (x), m->regs[(x)])
510 #define LRP(x) maven_set_reg_pair(c, (x), m->regs[(x)] | (m->regs[(x)+1] << 8))
511 static void maven_init_TV(struct i2c_client* c, const struct mavenregs* m) {
512 int val;
513
514
515 maven_set_reg(c, 0x3E, 0x01);
516 maven_get_reg(c, 0x82); /* fetch oscillator state? */
517 maven_set_reg(c, 0x8C, 0x00);
518 maven_get_reg(c, 0x94); /* get 0x82 */
519 maven_set_reg(c, 0x94, 0xA2);
520 /* xmiscctrl */
521
522 maven_set_reg_pair(c, 0x8E, 0x1EFF);
523 maven_set_reg(c, 0xC6, 0x01);
524
525 /* removed code... */
526
527 maven_get_reg(c, 0x06);
528 maven_set_reg(c, 0x06, 0xF9); /* or read |= 0xF0 ? */
529
530 /* removed code here... */
531
532 /* real code begins here? */
533 /* chroma subcarrier */
534 LR(0x00); LR(0x01); LR(0x02); LR(0x03);
535
536 LR(0x04);
537
538 LR(0x2C);
539 LR(0x08);
540 LR(0x0A);
541 LR(0x09);
542 LR(0x29);
543 LRP(0x31);
544 LRP(0x17);
545 LR(0x0B);
546 LR(0x0C);
547 if (m->mode == MATROXFB_OUTPUT_MODE_PAL) {
548 maven_set_reg(c, 0x35, 0x10); /* ... */
549 } else {
550 maven_set_reg(c, 0x35, 0x0F); /* ... */
551 }
552
553 LRP(0x10);
554
555 LRP(0x0E);
556 LRP(0x1E);
557
558 LR(0x20); /* saturation #1 */
559 LR(0x22); /* saturation #2 */
560 LR(0x25); /* hue */
561 LR(0x34);
562 LR(0x33);
563 LR(0x19);
564 LR(0x12);
565 LR(0x3B);
566 LR(0x13);
567 LR(0x39);
568 LR(0x1D);
569 LR(0x3A);
570 LR(0x24);
571 LR(0x14);
572 LR(0x15);
573 LR(0x16);
574 LRP(0x2D);
575 LRP(0x2F);
576 LR(0x1A);
577 LR(0x1B);
578 LR(0x1C);
579 LR(0x23);
580 LR(0x26);
581 LR(0x28);
582 LR(0x27);
583 LR(0x21);
584 LRP(0x2A);
585 if (m->mode == MATROXFB_OUTPUT_MODE_PAL)
586 maven_set_reg(c, 0x35, 0x1D); /* ... */
587 else
588 maven_set_reg(c, 0x35, 0x1C);
589
590 LRP(0x3C);
591 LR(0x37);
592 LR(0x38);
593 maven_set_reg(c, 0xB3, 0x01);
594
595 maven_get_reg(c, 0xB0); /* read 0x80 */
596 maven_set_reg(c, 0xB0, 0x08); /* ugh... */
597 maven_get_reg(c, 0xB9); /* read 0x7C */
598 maven_set_reg(c, 0xB9, 0x78);
599 maven_get_reg(c, 0xBF); /* read 0x00 */
600 maven_set_reg(c, 0xBF, 0x02);
601 maven_get_reg(c, 0x94); /* read 0x82 */
602 maven_set_reg(c, 0x94, 0xB3);
603
604 LR(0x80); /* 04 1A 91 or 05 21 91 */
605 LR(0x81);
606 LR(0x82);
607
608 maven_set_reg(c, 0x8C, 0x20);
609 maven_get_reg(c, 0x8D);
610 maven_set_reg(c, 0x8D, 0x10);
611
612 LR(0x90); /* 4D 50 52 or 4E 05 45 */
613 LR(0x91);
614 LR(0x92);
615
616 LRP(0x9A); /* 0049 or 004F */
617 LRP(0x9C); /* 0004 or 0004 */
618 LRP(0x9E); /* 0458 or 045E */
619 LRP(0xA0); /* 05DA or 051B */
620 LRP(0xA2); /* 00CC or 00CF */
621 LRP(0xA4); /* 007D or 007F */
622 LRP(0xA6); /* 007C or 007E */
623 LRP(0xA8); /* 03CB or 03CE */
624 LRP(0x98); /* 0000 or 0000 */
625 LRP(0xAE); /* 0044 or 003A */
626 LRP(0x96); /* 05DA or 051B */
627 LRP(0xAA); /* 04BC or 046A */
628 LRP(0xAC); /* 004D or 004E */
629
630 LR(0xBE);
631 LR(0xC2);
632
633 maven_get_reg(c, 0x8D);
634 maven_set_reg(c, 0x8D, 0x04);
635
636 LR(0x20); /* saturation #1 */
637 LR(0x22); /* saturation #2 */
638 LR(0x93); /* whoops */
639 LR(0x20); /* oh, saturation #1 again */
640 LR(0x22); /* oh, saturation #2 again */
641 LR(0x25); /* hue */
642 LRP(0x0E);
643 LRP(0x1E);
644 LRP(0x0E); /* problems with memory? */
645 LRP(0x1E); /* yes, matrox must have problems in memory area... */
646
647 /* load gamma correction stuff */
648 LR(0x83);
649 LR(0x84);
650 LR(0x85);
651 LR(0x86);
652 LR(0x87);
653 LR(0x88);
654 LR(0x89);
655 LR(0x8A);
656 LR(0x8B);
657
658 val = maven_get_reg(c, 0x8D);
659 val &= 0x14; /* 0x10 or anything ored with it */
660 maven_set_reg(c, 0x8D, val);
661
662 LR(0x33);
663 LR(0x19);
664 LR(0x12);
665 LR(0x3B);
666 LR(0x13);
667 LR(0x39);
668 LR(0x1D);
669 LR(0x3A);
670 LR(0x24);
671 LR(0x14);
672 LR(0x15);
673 LR(0x16);
674 LRP(0x2D);
675 LRP(0x2F);
676 LR(0x1A);
677 LR(0x1B);
678 LR(0x1C);
679 LR(0x23);
680 LR(0x26);
681 LR(0x28);
682 LR(0x27);
683 LR(0x21);
684 LRP(0x2A);
685 if (m->mode == MATROXFB_OUTPUT_MODE_PAL)
686 maven_set_reg(c, 0x35, 0x1D);
687 else
688 maven_set_reg(c, 0x35, 0x1C);
689 LRP(0x3C);
690 LR(0x37);
691 LR(0x38);
692
693 maven_get_reg(c, 0xB0);
694 LR(0xB0); /* output mode */
695 LR(0x90);
696 LR(0xBE);
697 LR(0xC2);
698
699 LRP(0x9A);
700 LRP(0xA2);
701 LRP(0x9E);
702 LRP(0xA6);
703 LRP(0xAA);
704 LRP(0xAC);
705 maven_set_reg(c, 0x3E, 0x00);
706 maven_set_reg(c, 0x95, 0x20);
707 }
708
709 static int maven_find_exact_clocks(unsigned int ht, unsigned int vt,
710 struct mavenregs* m) {
711 unsigned int x;
712 unsigned int err = ~0;
713
714 /* 1:1 */
715 m->regs[0x80] = 0x0F;
716 m->regs[0x81] = 0x07;
717 m->regs[0x82] = 0x81;
718
719 for (x = 0; x < 8; x++) {
720 unsigned int c;
721 unsigned int uninitialized_var(a), uninitialized_var(b),
722 uninitialized_var(h2);
723 unsigned int h = ht + 2 + x;
724
725 if (!matroxfb_mavenclock((m->mode == MATROXFB_OUTPUT_MODE_PAL) ? &maven_PAL : &maven_NTSC, h, vt, &a, &b, &c, &h2)) {
726 unsigned int diff = h - h2;
727
728 if (diff < err) {
729 err = diff;
730 m->regs[0x80] = a - 1;
731 m->regs[0x81] = b - 1;
732 m->regs[0x82] = c | 0x80;
733 m->hcorr = h2 - 2;
734 m->htotal = h - 2;
735 }
736 }
737 }
738 return err != ~0U;
739 }
740
741 static inline int maven_compute_timming(struct maven_data* md,
742 struct my_timming* mt,
743 struct mavenregs* m) {
744 unsigned int tmpi;
745 unsigned int a, bv, c;
746 MINFO_FROM(md->primary_head);
747
748 m->mode = ACCESS_FBINFO(outputs[1]).mode;
749 if (m->mode != MATROXFB_OUTPUT_MODE_MONITOR) {
750 unsigned int lmargin;
751 unsigned int umargin;
752 unsigned int vslen;
753 unsigned int hcrt;
754 unsigned int slen;
755
756 maven_init_TVdata(md, m);
757
758 if (maven_find_exact_clocks(mt->HTotal, mt->VTotal, m) == 0)
759 return -EINVAL;
760
761 lmargin = mt->HTotal - mt->HSyncEnd;
762 slen = mt->HSyncEnd - mt->HSyncStart;
763 hcrt = mt->HTotal - slen - mt->delay;
764 umargin = mt->VTotal - mt->VSyncEnd;
765 vslen = mt->VSyncEnd - mt->VSyncStart;
766
767 if (m->hcorr < mt->HTotal)
768 hcrt += m->hcorr;
769 if (hcrt > mt->HTotal)
770 hcrt -= mt->HTotal;
771 if (hcrt + 2 > mt->HTotal)
772 hcrt = 0; /* or issue warning? */
773
774 /* last (first? middle?) line in picture can have different length */
775 /* hlen - 2 */
776 m->regs[0x96] = m->hcorr;
777 m->regs[0x97] = m->hcorr >> 8;
778 /* ... */
779 m->regs[0x98] = 0x00; m->regs[0x99] = 0x00;
780 /* hblanking end */
781 m->regs[0x9A] = lmargin; /* 100% */
782 m->regs[0x9B] = lmargin >> 8; /* 100% */
783 /* who knows */
784 m->regs[0x9C] = 0x04;
785 m->regs[0x9D] = 0x00;
786 /* htotal - 2 */
787 m->regs[0xA0] = m->htotal;
788 m->regs[0xA1] = m->htotal >> 8;
789 /* vblanking end */
790 m->regs[0xA2] = mt->VTotal - mt->VSyncStart - 1; /* stop vblanking */
791 m->regs[0xA3] = (mt->VTotal - mt->VSyncStart - 1) >> 8;
792 /* something end... [A6]+1..[A8] */
793 if (md->version == MGATVO_B) {
794 m->regs[0xA4] = 0x04;
795 m->regs[0xA5] = 0x00;
796 } else {
797 m->regs[0xA4] = 0x01;
798 m->regs[0xA5] = 0x00;
799 }
800 /* something start... 0..[A4]-1 */
801 m->regs[0xA6] = 0x00;
802 m->regs[0xA7] = 0x00;
803 /* vertical line count - 1 */
804 m->regs[0xA8] = mt->VTotal - 1;
805 m->regs[0xA9] = (mt->VTotal - 1) >> 8;
806 /* horizontal vidrst pos */
807 m->regs[0xAA] = hcrt; /* 0 <= hcrt <= htotal - 2 */
808 m->regs[0xAB] = hcrt >> 8;
809 /* vertical vidrst pos */
810 m->regs[0xAC] = mt->VTotal - 2;
811 m->regs[0xAD] = (mt->VTotal - 2) >> 8;
812 /* moves picture up/down and so on... */
813 m->regs[0xAE] = 0x01; /* Fix this... 0..VTotal */
814 m->regs[0xAF] = 0x00;
815 {
816 int hdec;
817 int hlen;
818 unsigned int ibmin = 4 + lmargin + mt->HDisplay;
819 unsigned int ib;
820 int i;
821
822 /* Verify! */
823 /* Where 94208 came from? */
824 if (mt->HTotal)
825 hdec = 94208 / (mt->HTotal);
826 else
827 hdec = 0x81;
828 if (hdec > 0x81)
829 hdec = 0x81;
830 if (hdec < 0x41)
831 hdec = 0x41;
832 hdec--;
833 hlen = 98304 - 128 - ((lmargin + mt->HDisplay - 8) * hdec);
834 if (hlen < 0)
835 hlen = 0;
836 hlen = hlen >> 8;
837 if (hlen > 0xFF)
838 hlen = 0xFF;
839 /* Now we have to compute input buffer length.
840 If you want any picture, it must be between
841 4 + lmargin + xres
842 and
843 94208 / hdec
844 If you want perfect picture even on the top
845 of screen, it must be also
846 0x3C0000 * i / hdec + Q - R / hdec
847 where
848 R Qmin Qmax
849 0x07000 0x5AE 0x5BF
850 0x08000 0x5CF 0x5FF
851 0x0C000 0x653 0x67F
852 0x10000 0x6F8 0x6FF
853 */
854 i = 1;
855 do {
856 ib = ((0x3C0000 * i - 0x8000)/ hdec + 0x05E7) >> 8;
857 i++;
858 } while (ib < ibmin);
859 if (ib >= m->htotal + 2) {
860 ib = ibmin;
861 }
862
863 m->regs[0x90] = hdec; /* < 0x40 || > 0x80 is bad... 0x80 is questionable */
864 m->regs[0xC2] = hlen;
865 /* 'valid' input line length */
866 m->regs[0x9E] = ib;
867 m->regs[0x9F] = ib >> 8;
868 }
869 {
870 int vdec;
871 int vlen;
872
873 #define MATROX_USE64BIT_DIVIDE
874 if (mt->VTotal) {
875 #ifdef MATROX_USE64BIT_DIVIDE
876 u64 f1;
877 u32 a;
878 u32 b;
879
880 a = m->vlines * (m->htotal + 2);
881 b = (mt->VTotal - 1) * (m->htotal + 2) + m->hcorr + 2;
882
883 f1 = ((u64)a) << 15; /* *32768 */
884 do_div(f1, b);
885 vdec = f1;
886 #else
887 vdec = m->vlines * 32768 / mt->VTotal;
888 #endif
889 } else
890 vdec = 0x8000;
891 if (vdec > 0x8000)
892 vdec = 0x8000;
893 vlen = (vslen + umargin + mt->VDisplay) * vdec;
894 vlen = (vlen >> 16) - 146; /* FIXME: 146?! */
895 if (vlen < 0)
896 vlen = 0;
897 if (vlen > 0xFF)
898 vlen = 0xFF;
899 vdec--;
900 m->regs[0x91] = vdec;
901 m->regs[0x92] = vdec >> 8;
902 m->regs[0xBE] = vlen;
903 }
904 m->regs[0xB0] = 0x08; /* output: SVideo/Composite */
905 return 0;
906 }
907
908 DAC1064_calcclock(mt->pixclock, 450000, &a, &bv, &c);
909 m->regs[0x80] = a;
910 m->regs[0x81] = bv;
911 m->regs[0x82] = c | 0x80;
912
913 m->regs[0xB3] = 0x01;
914 m->regs[0x94] = 0xB2;
915
916 /* htotal... */
917 m->regs[0x96] = mt->HTotal;
918 m->regs[0x97] = mt->HTotal >> 8;
919 /* ?? */
920 m->regs[0x98] = 0x00;
921 m->regs[0x99] = 0x00;
922 /* hsync len */
923 tmpi = mt->HSyncEnd - mt->HSyncStart;
924 m->regs[0x9A] = tmpi;
925 m->regs[0x9B] = tmpi >> 8;
926 /* hblank end */
927 tmpi = mt->HTotal - mt->HSyncStart;
928 m->regs[0x9C] = tmpi;
929 m->regs[0x9D] = tmpi >> 8;
930 /* hblank start */
931 tmpi += mt->HDisplay;
932 m->regs[0x9E] = tmpi;
933 m->regs[0x9F] = tmpi >> 8;
934 /* htotal + 1 */
935 tmpi = mt->HTotal + 1;
936 m->regs[0xA0] = tmpi;
937 m->regs[0xA1] = tmpi >> 8;
938 /* vsync?! */
939 tmpi = mt->VSyncEnd - mt->VSyncStart - 1;
940 m->regs[0xA2] = tmpi;
941 m->regs[0xA3] = tmpi >> 8;
942 /* ignored? */
943 tmpi = mt->VTotal - mt->VSyncStart;
944 m->regs[0xA4] = tmpi;
945 m->regs[0xA5] = tmpi >> 8;
946 /* ignored? */
947 tmpi = mt->VTotal - 1;
948 m->regs[0xA6] = tmpi;
949 m->regs[0xA7] = tmpi >> 8;
950 /* vtotal - 1 */
951 m->regs[0xA8] = tmpi;
952 m->regs[0xA9] = tmpi >> 8;
953 /* hor vidrst */
954 tmpi = mt->HTotal - mt->delay;
955 m->regs[0xAA] = tmpi;
956 m->regs[0xAB] = tmpi >> 8;
957 /* vert vidrst */
958 tmpi = mt->VTotal - 2;
959 m->regs[0xAC] = tmpi;
960 m->regs[0xAD] = tmpi >> 8;
961 /* ignored? */
962 m->regs[0xAE] = 0x00;
963 m->regs[0xAF] = 0x00;
964
965 m->regs[0xB0] = 0x03; /* output: monitor */
966 m->regs[0xB1] = 0xA0; /* ??? */
967 m->regs[0x8C] = 0x20; /* must be set... */
968 m->regs[0x8D] = 0x04; /* defaults to 0x10: test signal */
969 m->regs[0xB9] = 0x1A; /* defaults to 0x2C: too bright */
970 m->regs[0xBF] = 0x22; /* makes picture stable */
971
972 return 0;
973 }
974
975 static int maven_program_timming(struct maven_data* md,
976 const struct mavenregs* m) {
977 struct i2c_client* c = &md->client;
978
979 if (m->mode == MATROXFB_OUTPUT_MODE_MONITOR) {
980 LR(0x80);
981 LR(0x81);
982 LR(0x82);
983
984 LR(0xB3);
985 LR(0x94);
986
987 LRP(0x96);
988 LRP(0x98);
989 LRP(0x9A);
990 LRP(0x9C);
991 LRP(0x9E);
992 LRP(0xA0);
993 LRP(0xA2);
994 LRP(0xA4);
995 LRP(0xA6);
996 LRP(0xA8);
997 LRP(0xAA);
998 LRP(0xAC);
999 LRP(0xAE);
1000
1001 LR(0xB0); /* output: monitor */
1002 LR(0xB1); /* ??? */
1003 LR(0x8C); /* must be set... */
1004 LR(0x8D); /* defaults to 0x10: test signal */
1005 LR(0xB9); /* defaults to 0x2C: too bright */
1006 LR(0xBF); /* makes picture stable */
1007 } else {
1008 maven_init_TV(c, m);
1009 }
1010 return 0;
1011 }
1012
1013 static inline int maven_resync(struct maven_data* md) {
1014 struct i2c_client* c = &md->client;
1015 maven_set_reg(c, 0x95, 0x20); /* start whole thing */
1016 return 0;
1017 }
1018
1019 static int maven_get_queryctrl (struct maven_data* md,
1020 struct v4l2_queryctrl *p) {
1021 int i;
1022
1023 i = get_ctrl_id(p->id);
1024 if (i >= 0) {
1025 *p = maven_controls[i].desc;
1026 return 0;
1027 }
1028 if (i == -ENOENT) {
1029 static const struct v4l2_queryctrl disctrl =
1030 { .flags = V4L2_CTRL_FLAG_DISABLED };
1031
1032 i = p->id;
1033 *p = disctrl;
1034 p->id = i;
1035 sprintf(p->name, "Ctrl #%08X", i);
1036 return 0;
1037 }
1038 return -EINVAL;
1039 }
1040
1041 static int maven_set_control (struct maven_data* md,
1042 struct v4l2_control *p) {
1043 int i;
1044
1045 i = get_ctrl_id(p->id);
1046 if (i < 0) return -EINVAL;
1047
1048 /*
1049 * Check if changed.
1050 */
1051 if (p->value == *get_ctrl_ptr(md, i)) return 0;
1052
1053 /*
1054 * Check limits.
1055 */
1056 if (p->value > maven_controls[i].desc.maximum) return -EINVAL;
1057 if (p->value < maven_controls[i].desc.minimum) return -EINVAL;
1058
1059 /*
1060 * Store new value.
1061 */
1062 *get_ctrl_ptr(md, i) = p->value;
1063
1064 switch (p->id) {
1065 case V4L2_CID_BRIGHTNESS:
1066 case V4L2_CID_CONTRAST:
1067 {
1068 int blacklevel, whitelevel;
1069 maven_compute_bwlevel(md, &blacklevel, &whitelevel);
1070 blacklevel = (blacklevel >> 2) | ((blacklevel & 3) << 8);
1071 whitelevel = (whitelevel >> 2) | ((whitelevel & 3) << 8);
1072 maven_set_reg_pair(&md->client, 0x0e, blacklevel);
1073 maven_set_reg_pair(&md->client, 0x1e, whitelevel);
1074 }
1075 break;
1076 case V4L2_CID_SATURATION:
1077 {
1078 maven_set_reg(&md->client, 0x20, p->value);
1079 maven_set_reg(&md->client, 0x22, p->value);
1080 }
1081 break;
1082 case V4L2_CID_HUE:
1083 {
1084 maven_set_reg(&md->client, 0x25, p->value);
1085 }
1086 break;
1087 case V4L2_CID_GAMMA:
1088 {
1089 const struct maven_gamma* g;
1090 g = maven_compute_gamma(md);
1091 maven_set_reg(&md->client, 0x83, g->reg83);
1092 maven_set_reg(&md->client, 0x84, g->reg84);
1093 maven_set_reg(&md->client, 0x85, g->reg85);
1094 maven_set_reg(&md->client, 0x86, g->reg86);
1095 maven_set_reg(&md->client, 0x87, g->reg87);
1096 maven_set_reg(&md->client, 0x88, g->reg88);
1097 maven_set_reg(&md->client, 0x89, g->reg89);
1098 maven_set_reg(&md->client, 0x8a, g->reg8a);
1099 maven_set_reg(&md->client, 0x8b, g->reg8b);
1100 }
1101 break;
1102 case MATROXFB_CID_TESTOUT:
1103 {
1104 unsigned char val
1105 = maven_get_reg(&md->client,0x8d);
1106 if (p->value) val |= 0x10;
1107 else val &= ~0x10;
1108 maven_set_reg(&md->client, 0x8d, val);
1109 }
1110 break;
1111 case MATROXFB_CID_DEFLICKER:
1112 {
1113 maven_set_reg(&md->client, 0x93, maven_compute_deflicker(md));
1114 }
1115 break;
1116 }
1117
1118
1119 return 0;
1120 }
1121
1122 static int maven_get_control (struct maven_data* md,
1123 struct v4l2_control *p) {
1124 int i;
1125
1126 i = get_ctrl_id(p->id);
1127 if (i < 0) return -EINVAL;
1128 p->value = *get_ctrl_ptr(md, i);
1129 return 0;
1130 }
1131
1132 /******************************************************/
1133
1134 static int maven_out_compute(void* md, struct my_timming* mt) {
1135 #define mdinfo ((struct maven_data*)md)
1136 #define minfo (mdinfo->primary_head)
1137 return maven_compute_timming(md, mt, &ACCESS_FBINFO(hw).maven);
1138 #undef minfo
1139 #undef mdinfo
1140 }
1141
1142 static int maven_out_program(void* md) {
1143 #define mdinfo ((struct maven_data*)md)
1144 #define minfo (mdinfo->primary_head)
1145 return maven_program_timming(md, &ACCESS_FBINFO(hw).maven);
1146 #undef minfo
1147 #undef mdinfo
1148 }
1149
1150 static int maven_out_start(void* md) {
1151 return maven_resync(md);
1152 }
1153
1154 static int maven_out_verify_mode(void* md, u_int32_t arg) {
1155 switch (arg) {
1156 case MATROXFB_OUTPUT_MODE_PAL:
1157 case MATROXFB_OUTPUT_MODE_NTSC:
1158 case MATROXFB_OUTPUT_MODE_MONITOR:
1159 return 0;
1160 }
1161 return -EINVAL;
1162 }
1163
1164 static int maven_out_get_queryctrl(void* md, struct v4l2_queryctrl* p) {
1165 return maven_get_queryctrl(md, p);
1166 }
1167
1168 static int maven_out_get_ctrl(void* md, struct v4l2_control* p) {
1169 return maven_get_control(md, p);
1170 }
1171
1172 static int maven_out_set_ctrl(void* md, struct v4l2_control* p) {
1173 return maven_set_control(md, p);
1174 }
1175
1176 static struct matrox_altout maven_altout = {
1177 .name = "Secondary output",
1178 .compute = maven_out_compute,
1179 .program = maven_out_program,
1180 .start = maven_out_start,
1181 .verifymode = maven_out_verify_mode,
1182 .getqueryctrl = maven_out_get_queryctrl,
1183 .getctrl = maven_out_get_ctrl,
1184 .setctrl = maven_out_set_ctrl,
1185 };
1186
1187 static int maven_init_client(struct i2c_client* clnt) {
1188 struct maven_data* md = i2c_get_clientdata(clnt);
1189 MINFO_FROM(container_of(clnt->adapter, struct i2c_bit_adapter, adapter)->minfo);
1190
1191 md->primary_head = MINFO;
1192 down_write(&ACCESS_FBINFO(altout.lock));
1193 ACCESS_FBINFO(outputs[1]).output = &maven_altout;
1194 ACCESS_FBINFO(outputs[1]).src = ACCESS_FBINFO(outputs[1]).default_src;
1195 ACCESS_FBINFO(outputs[1]).data = md;
1196 ACCESS_FBINFO(outputs[1]).mode = MATROXFB_OUTPUT_MODE_MONITOR;
1197 up_write(&ACCESS_FBINFO(altout.lock));
1198 if (maven_get_reg(clnt, 0xB2) < 0x14) {
1199 md->version = MGATVO_B;
1200 /* Tweak some things for this old chip */
1201 } else {
1202 md->version = MGATVO_C;
1203 }
1204 /*
1205 * Set all parameters to its initial values.
1206 */
1207 {
1208 unsigned int i;
1209
1210 for (i = 0; i < MAVCTRLS; ++i) {
1211 *get_ctrl_ptr(md, i) = maven_controls[i].desc.default_value;
1212 }
1213 }
1214
1215 return 0;
1216 }
1217
1218 static int maven_shutdown_client(struct i2c_client* clnt) {
1219 struct maven_data* md = i2c_get_clientdata(clnt);
1220
1221 if (md->primary_head) {
1222 MINFO_FROM(md->primary_head);
1223
1224 down_write(&ACCESS_FBINFO(altout.lock));
1225 ACCESS_FBINFO(outputs[1]).src = MATROXFB_SRC_NONE;
1226 ACCESS_FBINFO(outputs[1]).output = NULL;
1227 ACCESS_FBINFO(outputs[1]).data = NULL;
1228 ACCESS_FBINFO(outputs[1]).mode = MATROXFB_OUTPUT_MODE_MONITOR;
1229 up_write(&ACCESS_FBINFO(altout.lock));
1230 md->primary_head = NULL;
1231 }
1232 return 0;
1233 }
1234
1235 static const unsigned short normal_i2c[] = { MAVEN_I2CID, I2C_CLIENT_END };
1236 I2C_CLIENT_INSMOD;
1237
1238 static struct i2c_driver maven_driver;
1239
1240 static int maven_detect_client(struct i2c_adapter* adapter, int address, int kind) {
1241 int err = 0;
1242 struct i2c_client* new_client;
1243 struct maven_data* data;
1244
1245 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_WORD_DATA |
1246 I2C_FUNC_SMBUS_BYTE_DATA |
1247 I2C_FUNC_PROTOCOL_MANGLING))
1248 goto ERROR0;
1249 if (!(data = kzalloc(sizeof(*data), GFP_KERNEL))) {
1250 err = -ENOMEM;
1251 goto ERROR0;
1252 }
1253 new_client = &data->client;
1254 i2c_set_clientdata(new_client, data);
1255 new_client->addr = address;
1256 new_client->adapter = adapter;
1257 new_client->driver = &maven_driver;
1258 new_client->flags = 0;
1259 strlcpy(new_client->name, "maven", I2C_NAME_SIZE);
1260 if ((err = i2c_attach_client(new_client)))
1261 goto ERROR3;
1262 err = maven_init_client(new_client);
1263 if (err)
1264 goto ERROR4;
1265 return 0;
1266 ERROR4:;
1267 i2c_detach_client(new_client);
1268 ERROR3:;
1269 kfree(new_client);
1270 ERROR0:;
1271 return err;
1272 }
1273
1274 static int maven_attach_adapter(struct i2c_adapter* adapter) {
1275 if (adapter->id == I2C_HW_B_G400)
1276 return i2c_probe(adapter, &addr_data, &maven_detect_client);
1277 return 0;
1278 }
1279
1280 static int maven_detach_client(struct i2c_client* client) {
1281 int err;
1282
1283 if ((err = i2c_detach_client(client)))
1284 return err;
1285 maven_shutdown_client(client);
1286 kfree(i2c_get_clientdata(client));
1287 return 0;
1288 }
1289
1290 static struct i2c_driver maven_driver={
1291 .driver = {
1292 .name = "maven",
1293 },
1294 .id = I2C_DRIVERID_MGATVO,
1295 .attach_adapter = maven_attach_adapter,
1296 .detach_client = maven_detach_client,
1297 };
1298
1299 static int __init matroxfb_maven_init(void)
1300 {
1301 return i2c_add_driver(&maven_driver);
1302 }
1303
1304 static void __exit matroxfb_maven_exit(void)
1305 {
1306 i2c_del_driver(&maven_driver);
1307 }
1308
1309 MODULE_AUTHOR("(c) 1999-2002 Petr Vandrovec <vandrove@vc.cvut.cz>");
1310 MODULE_DESCRIPTION("Matrox G200/G400 Matrox MGA-TVO driver");
1311 MODULE_LICENSE("GPL");
1312 module_init(matroxfb_maven_init);
1313 module_exit(matroxfb_maven_exit);
1314 /* we do not have __setup() yet */
WRT350N Kernel Patches