1303 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*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/1411 *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 125#define MGATVO_C 226 27static 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 */60struct mctl {61 struct v4l2_queryctrl desc;62 size_t control;63};64 65#define BLMIN 0x0FF66#define WLMAX 0x3FF67 68static 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 found110 -EINVAL: id not found, return failure111 -ENOENT: id not found, create fake disabled control */112static 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 129struct maven_data {130 struct matrox_fb_info* primary_head;131 struct i2c_client *client;132 int version;133};134 135static int* get_ctrl_ptr(struct maven_data* md, int idx) {136 return (int*)((char*)(md->primary_head) + maven_controls[idx].control);137}138 139static 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 = ®147 },148 {149 .addr = c->addr,150 .flags = I2C_M_RD | I2C_M_NOSTART,151 .len = sizeof(dst),152 .buf = &dst153 }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 163static 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 172static 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 181static const struct matrox_pll_features maven_pll = {182 50000,183 27000,184 4, 127,185 2, 31,186 3187};188 189struct 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 199struct matrox_pll_ctl {200 unsigned int ref_freq;201 unsigned int den;202};203 204static 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 = 3212};213 214static const struct matrox_pll_ctl maven_PAL = {215 .ref_freq = 540000,216 .den = 50217};218 219static const struct matrox_pll_ctl maven_NTSC = {220 .ref_freq = 450450, /* 27027000/60 == 27000000/59.94005994 */221 .den = 60222};223 224static 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 298static 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 else316 p |= 0x18;317 *post = p;318 return 0;319}320 321static 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 else335 p |= 0x18;336 *post = p;337 return;338}339 340static 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 358static 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 367static 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 372static 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 else482 *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))525static 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 else602 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 else702 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 723static 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 755static 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 else841 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 between855 4 + lmargin + xres856 and857 94208 / hdec858 If you want perfect picture even on the top859 of screen, it must be also860 0x3C0000 * i / hdec + Q - R / hdec861 where862 R Qmin Qmax863 0x07000 0x5AE 0x5BF864 0x08000 0x5CF 0x5FF865 0x0C000 0x653 0x67F866 0x10000 0x6F8 0x6FF867 */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_DIVIDE888 if (mt->VTotal) {889#ifdef MATROX_USE64BIT_DIVIDE890 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#else901 vdec = m->vlines * 32768 / mt->VTotal;902#endif903 } else904 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 989static 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 1027static 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 1033static 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 1055static 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 1136static 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 1148static 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 minfo1153#undef mdinfo1154}1155 1156static 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 minfo1161#undef mdinfo1162}1163 1164static int maven_out_start(void* md) {1165 return maven_resync(md);1166}1167 1168static 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 1178static int maven_out_get_queryctrl(void* md, struct v4l2_queryctrl* p) {1179 return maven_get_queryctrl(md, p);1180}1181 1182static int maven_out_get_ctrl(void* md, struct v4l2_control* p) {1183 return maven_get_control(md, p);1184}1185 1186static int maven_out_set_ctrl(void* md, struct v4l2_control* p) {1187 return maven_set_control(md, p);1188}1189 1190static 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 1201static 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 1235static 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 1252static 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;1272ERROR4:;1273 kfree(data);1274ERROR0:;1275 return err;1276}1277 1278static void maven_remove(struct i2c_client *client)1279{1280 maven_shutdown_client(client);1281 kfree(i2c_get_clientdata(client));1282}1283 1284static const struct i2c_device_id maven_id[] = {1285 { "maven" },1286 { }1287};1288MODULE_DEVICE_TABLE(i2c, maven_id);1289 1290static 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 1299module_i2c_driver(maven_driver);1300MODULE_AUTHOR("(c) 1999-2002 Petr Vandrovec <vandrove@vc.cvut.cz>");1301MODULE_DESCRIPTION("Matrox G200/G400 Matrox MGA-TVO driver");1302MODULE_LICENSE("GPL");1303