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