]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/media/dvb-frontends/nxt200x.c
Merge branch 'for-4.11' of git://git.kernel.org/pub/scm/linux/kernel/git/tj/wq
[karo-tx-linux.git] / drivers / media / dvb-frontends / nxt200x.c
1 /*
2  *    Support for NXT2002 and NXT2004 - VSB/QAM
3  *
4  *    Copyright (C) 2005 Kirk Lapray <kirk.lapray@gmail.com>
5  *    Copyright (C) 2006-2014 Michael Krufky <mkrufky@linuxtv.org>
6  *    based on nxt2002 by Taylor Jacob <rtjacob@earthlink.net>
7  *    and nxt2004 by Jean-Francois Thibert <jeanfrancois@sagetv.com>
8  *
9  *    This program is free software; you can redistribute it and/or modify
10  *    it under the terms of the GNU General Public License as published by
11  *    the Free Software Foundation; either version 2 of the License, or
12  *    (at your option) any later version.
13  *
14  *    This program is distributed in the hope that it will be useful,
15  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
16  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  *    GNU General Public License for more details.
18  *
19 */
20
21 /*
22  *                      NOTES ABOUT THIS DRIVER
23  *
24  * This Linux driver supports:
25  *   B2C2/BBTI Technisat Air2PC - ATSC (NXT2002)
26  *   AverTVHD MCE A180 (NXT2004)
27  *   ATI HDTV Wonder (NXT2004)
28  *
29  * This driver needs external firmware. Please use the command
30  * "<kerneldir>/Documentation/dvb/get_dvb_firmware nxt2002" or
31  * "<kerneldir>/Documentation/dvb/get_dvb_firmware nxt2004" to
32  * download/extract the appropriate firmware, and then copy it to
33  * /usr/lib/hotplug/firmware/ or /lib/firmware/
34  * (depending on configuration of firmware hotplug).
35  */
36 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
37
38 /* Max transfer size done by I2C transfer functions */
39 #define MAX_XFER_SIZE  256
40
41 #define NXT2002_DEFAULT_FIRMWARE "dvb-fe-nxt2002.fw"
42 #define NXT2004_DEFAULT_FIRMWARE "dvb-fe-nxt2004.fw"
43 #define CRC_CCIT_MASK 0x1021
44
45 #include <linux/kernel.h>
46 #include <linux/init.h>
47 #include <linux/module.h>
48 #include <linux/slab.h>
49 #include <linux/string.h>
50
51 #include "dvb_frontend.h"
52 #include "nxt200x.h"
53
54 struct nxt200x_state {
55
56         struct i2c_adapter* i2c;
57         const struct nxt200x_config* config;
58         struct dvb_frontend frontend;
59
60         /* demodulator private data */
61         nxt_chip_type demod_chip;
62         u8 initialised:1;
63 };
64
65 static int debug;
66 #define dprintk(args...)        do { if (debug) pr_debug(args); } while (0)
67
68 static int i2c_writebytes (struct nxt200x_state* state, u8 addr, u8 *buf, u8 len)
69 {
70         int err;
71         struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = buf, .len = len };
72
73         if ((err = i2c_transfer (state->i2c, &msg, 1)) != 1) {
74                 pr_warn("%s: i2c write error (addr 0x%02x, err == %i)\n",
75                         __func__, addr, err);
76                 return -EREMOTEIO;
77         }
78         return 0;
79 }
80
81 static int i2c_readbytes(struct nxt200x_state *state, u8 addr, u8 *buf, u8 len)
82 {
83         int err;
84         struct i2c_msg msg = { .addr = addr, .flags = I2C_M_RD, .buf = buf, .len = len };
85
86         if ((err = i2c_transfer (state->i2c, &msg, 1)) != 1) {
87                 pr_warn("%s: i2c read error (addr 0x%02x, err == %i)\n",
88                         __func__, addr, err);
89                 return -EREMOTEIO;
90         }
91         return 0;
92 }
93
94 static int nxt200x_writebytes (struct nxt200x_state* state, u8 reg,
95                                const u8 *buf, u8 len)
96 {
97         u8 buf2[MAX_XFER_SIZE];
98         int err;
99         struct i2c_msg msg = { .addr = state->config->demod_address, .flags = 0, .buf = buf2, .len = len + 1 };
100
101         if (1 + len > sizeof(buf2)) {
102                 pr_warn("%s: i2c wr reg=%04x: len=%d is too big!\n",
103                          __func__, reg, len);
104                 return -EINVAL;
105         }
106
107         buf2[0] = reg;
108         memcpy(&buf2[1], buf, len);
109
110         if ((err = i2c_transfer (state->i2c, &msg, 1)) != 1) {
111                 pr_warn("%s: i2c write error (addr 0x%02x, err == %i)\n",
112                         __func__, state->config->demod_address, err);
113                 return -EREMOTEIO;
114         }
115         return 0;
116 }
117
118 static int nxt200x_readbytes(struct nxt200x_state *state, u8 reg, u8 *buf, u8 len)
119 {
120         u8 reg2 [] = { reg };
121
122         struct i2c_msg msg [] = { { .addr = state->config->demod_address, .flags = 0, .buf = reg2, .len = 1 },
123                         { .addr = state->config->demod_address, .flags = I2C_M_RD, .buf = buf, .len = len } };
124
125         int err;
126
127         if ((err = i2c_transfer (state->i2c, msg, 2)) != 2) {
128                 pr_warn("%s: i2c read error (addr 0x%02x, err == %i)\n",
129                         __func__, state->config->demod_address, err);
130                 return -EREMOTEIO;
131         }
132         return 0;
133 }
134
135 static u16 nxt200x_crc(u16 crc, u8 c)
136 {
137         u8 i;
138         u16 input = (u16) c & 0xFF;
139
140         input<<=8;
141         for(i=0; i<8; i++) {
142                 if((crc^input) & 0x8000)
143                         crc=(crc<<1)^CRC_CCIT_MASK;
144                 else
145                         crc<<=1;
146                 input<<=1;
147         }
148         return crc;
149 }
150
151 static int nxt200x_writereg_multibyte (struct nxt200x_state* state, u8 reg, u8* data, u8 len)
152 {
153         u8 attr, len2, buf;
154         dprintk("%s\n", __func__);
155
156         /* set mutli register register */
157         nxt200x_writebytes(state, 0x35, &reg, 1);
158
159         /* send the actual data */
160         nxt200x_writebytes(state, 0x36, data, len);
161
162         switch (state->demod_chip) {
163                 case NXT2002:
164                         len2 = len;
165                         buf = 0x02;
166                         break;
167                 case NXT2004:
168                         /* probably not right, but gives correct values */
169                         attr = 0x02;
170                         if (reg & 0x80) {
171                                 attr = attr << 1;
172                                 if (reg & 0x04)
173                                         attr = attr >> 1;
174                         }
175                         /* set write bit */
176                         len2 = ((attr << 4) | 0x10) | len;
177                         buf = 0x80;
178                         break;
179                 default:
180                         return -EINVAL;
181                         break;
182         }
183
184         /* set multi register length */
185         nxt200x_writebytes(state, 0x34, &len2, 1);
186
187         /* toggle the multireg write bit */
188         nxt200x_writebytes(state, 0x21, &buf, 1);
189
190         nxt200x_readbytes(state, 0x21, &buf, 1);
191
192         switch (state->demod_chip) {
193                 case NXT2002:
194                         if ((buf & 0x02) == 0)
195                                 return 0;
196                         break;
197                 case NXT2004:
198                         if (buf == 0)
199                                 return 0;
200                         break;
201                 default:
202                         return -EINVAL;
203                         break;
204         }
205
206         pr_warn("Error writing multireg register 0x%02X\n", reg);
207
208         return 0;
209 }
210
211 static int nxt200x_readreg_multibyte (struct nxt200x_state* state, u8 reg, u8* data, u8 len)
212 {
213         int i;
214         u8 buf, len2, attr;
215         dprintk("%s\n", __func__);
216
217         /* set mutli register register */
218         nxt200x_writebytes(state, 0x35, &reg, 1);
219
220         switch (state->demod_chip) {
221                 case NXT2002:
222                         /* set multi register length */
223                         len2 = len & 0x80;
224                         nxt200x_writebytes(state, 0x34, &len2, 1);
225
226                         /* read the actual data */
227                         nxt200x_readbytes(state, reg, data, len);
228                         return 0;
229                         break;
230                 case NXT2004:
231                         /* probably not right, but gives correct values */
232                         attr = 0x02;
233                         if (reg & 0x80) {
234                                 attr = attr << 1;
235                                 if (reg & 0x04)
236                                         attr = attr >> 1;
237                         }
238
239                         /* set multi register length */
240                         len2 = (attr << 4) | len;
241                         nxt200x_writebytes(state, 0x34, &len2, 1);
242
243                         /* toggle the multireg bit*/
244                         buf = 0x80;
245                         nxt200x_writebytes(state, 0x21, &buf, 1);
246
247                         /* read the actual data */
248                         for(i = 0; i < len; i++) {
249                                 nxt200x_readbytes(state, 0x36 + i, &data[i], 1);
250                         }
251                         return 0;
252                         break;
253                 default:
254                         return -EINVAL;
255                         break;
256         }
257 }
258
259 static void nxt200x_microcontroller_stop (struct nxt200x_state* state)
260 {
261         u8 buf, stopval, counter = 0;
262         dprintk("%s\n", __func__);
263
264         /* set correct stop value */
265         switch (state->demod_chip) {
266                 case NXT2002:
267                         stopval = 0x40;
268                         break;
269                 case NXT2004:
270                         stopval = 0x10;
271                         break;
272                 default:
273                         stopval = 0;
274                         break;
275         }
276
277         buf = 0x80;
278         nxt200x_writebytes(state, 0x22, &buf, 1);
279
280         while (counter < 20) {
281                 nxt200x_readbytes(state, 0x31, &buf, 1);
282                 if (buf & stopval)
283                         return;
284                 msleep(10);
285                 counter++;
286         }
287
288         pr_warn("Timeout waiting for nxt200x to stop. This is ok after firmware upload.\n");
289         return;
290 }
291
292 static void nxt200x_microcontroller_start (struct nxt200x_state* state)
293 {
294         u8 buf;
295         dprintk("%s\n", __func__);
296
297         buf = 0x00;
298         nxt200x_writebytes(state, 0x22, &buf, 1);
299 }
300
301 static void nxt2004_microcontroller_init (struct nxt200x_state* state)
302 {
303         u8 buf[9];
304         u8 counter = 0;
305         dprintk("%s\n", __func__);
306
307         buf[0] = 0x00;
308         nxt200x_writebytes(state, 0x2b, buf, 1);
309         buf[0] = 0x70;
310         nxt200x_writebytes(state, 0x34, buf, 1);
311         buf[0] = 0x04;
312         nxt200x_writebytes(state, 0x35, buf, 1);
313         buf[0] = 0x01; buf[1] = 0x23; buf[2] = 0x45; buf[3] = 0x67; buf[4] = 0x89;
314         buf[5] = 0xAB; buf[6] = 0xCD; buf[7] = 0xEF; buf[8] = 0xC0;
315         nxt200x_writebytes(state, 0x36, buf, 9);
316         buf[0] = 0x80;
317         nxt200x_writebytes(state, 0x21, buf, 1);
318
319         while (counter < 20) {
320                 nxt200x_readbytes(state, 0x21, buf, 1);
321                 if (buf[0] == 0)
322                         return;
323                 msleep(10);
324                 counter++;
325         }
326
327         pr_warn("Timeout waiting for nxt2004 to init.\n");
328
329         return;
330 }
331
332 static int nxt200x_writetuner (struct nxt200x_state* state, u8* data)
333 {
334         u8 buf, count = 0;
335
336         dprintk("%s\n", __func__);
337
338         dprintk("Tuner Bytes: %*ph\n", 4, data + 1);
339
340         /* if NXT2004, write directly to tuner. if NXT2002, write through NXT chip.
341          * direct write is required for Philips TUV1236D and ALPS TDHU2 */
342         switch (state->demod_chip) {
343                 case NXT2004:
344                         if (i2c_writebytes(state, data[0], data+1, 4))
345                                 pr_warn("error writing to tuner\n");
346                         /* wait until we have a lock */
347                         while (count < 20) {
348                                 i2c_readbytes(state, data[0], &buf, 1);
349                                 if (buf & 0x40)
350                                         return 0;
351                                 msleep(100);
352                                 count++;
353                         }
354                         pr_warn("timeout waiting for tuner lock\n");
355                         break;
356                 case NXT2002:
357                         /* set the i2c transfer speed to the tuner */
358                         buf = 0x03;
359                         nxt200x_writebytes(state, 0x20, &buf, 1);
360
361                         /* setup to transfer 4 bytes via i2c */
362                         buf = 0x04;
363                         nxt200x_writebytes(state, 0x34, &buf, 1);
364
365                         /* write actual tuner bytes */
366                         nxt200x_writebytes(state, 0x36, data+1, 4);
367
368                         /* set tuner i2c address */
369                         buf = data[0] << 1;
370                         nxt200x_writebytes(state, 0x35, &buf, 1);
371
372                         /* write UC Opmode to begin transfer */
373                         buf = 0x80;
374                         nxt200x_writebytes(state, 0x21, &buf, 1);
375
376                         while (count < 20) {
377                                 nxt200x_readbytes(state, 0x21, &buf, 1);
378                                 if ((buf & 0x80)== 0x00)
379                                         return 0;
380                                 msleep(100);
381                                 count++;
382                         }
383                         pr_warn("timeout error writing to tuner\n");
384                         break;
385                 default:
386                         return -EINVAL;
387                         break;
388         }
389         return 0;
390 }
391
392 static void nxt200x_agc_reset(struct nxt200x_state* state)
393 {
394         u8 buf;
395         dprintk("%s\n", __func__);
396
397         switch (state->demod_chip) {
398                 case NXT2002:
399                         buf = 0x08;
400                         nxt200x_writebytes(state, 0x08, &buf, 1);
401                         buf = 0x00;
402                         nxt200x_writebytes(state, 0x08, &buf, 1);
403                         break;
404                 case NXT2004:
405                         nxt200x_readreg_multibyte(state, 0x08, &buf, 1);
406                         buf = 0x08;
407                         nxt200x_writereg_multibyte(state, 0x08, &buf, 1);
408                         buf = 0x00;
409                         nxt200x_writereg_multibyte(state, 0x08, &buf, 1);
410                         break;
411                 default:
412                         break;
413         }
414         return;
415 }
416
417 static int nxt2002_load_firmware (struct dvb_frontend* fe, const struct firmware *fw)
418 {
419
420         struct nxt200x_state* state = fe->demodulator_priv;
421         u8 buf[3], written = 0, chunkpos = 0;
422         u16 rambase, position, crc = 0;
423
424         dprintk("%s\n", __func__);
425         dprintk("Firmware is %zu bytes\n", fw->size);
426
427         /* Get the RAM base for this nxt2002 */
428         nxt200x_readbytes(state, 0x10, buf, 1);
429
430         if (buf[0] & 0x10)
431                 rambase = 0x1000;
432         else
433                 rambase = 0x0000;
434
435         dprintk("rambase on this nxt2002 is %04X\n", rambase);
436
437         /* Hold the micro in reset while loading firmware */
438         buf[0] = 0x80;
439         nxt200x_writebytes(state, 0x2B, buf, 1);
440
441         for (position = 0; position < fw->size; position++) {
442                 if (written == 0) {
443                         crc = 0;
444                         chunkpos = 0x28;
445                         buf[0] = ((rambase + position) >> 8);
446                         buf[1] = (rambase + position) & 0xFF;
447                         buf[2] = 0x81;
448                         /* write starting address */
449                         nxt200x_writebytes(state, 0x29, buf, 3);
450                 }
451                 written++;
452                 chunkpos++;
453
454                 if ((written % 4) == 0)
455                         nxt200x_writebytes(state, chunkpos, &fw->data[position-3], 4);
456
457                 crc = nxt200x_crc(crc, fw->data[position]);
458
459                 if ((written == 255) || (position+1 == fw->size)) {
460                         /* write remaining bytes of firmware */
461                         nxt200x_writebytes(state, chunkpos+4-(written %4),
462                                 &fw->data[position-(written %4) + 1],
463                                 written %4);
464                         buf[0] = crc << 8;
465                         buf[1] = crc & 0xFF;
466
467                         /* write crc */
468                         nxt200x_writebytes(state, 0x2C, buf, 2);
469
470                         /* do a read to stop things */
471                         nxt200x_readbytes(state, 0x2A, buf, 1);
472
473                         /* set transfer mode to complete */
474                         buf[0] = 0x80;
475                         nxt200x_writebytes(state, 0x2B, buf, 1);
476
477                         written = 0;
478                 }
479         }
480
481         return 0;
482 };
483
484 static int nxt2004_load_firmware (struct dvb_frontend* fe, const struct firmware *fw)
485 {
486
487         struct nxt200x_state* state = fe->demodulator_priv;
488         u8 buf[3];
489         u16 rambase, position, crc=0;
490
491         dprintk("%s\n", __func__);
492         dprintk("Firmware is %zu bytes\n", fw->size);
493
494         /* set rambase */
495         rambase = 0x1000;
496
497         /* hold the micro in reset while loading firmware */
498         buf[0] = 0x80;
499         nxt200x_writebytes(state, 0x2B, buf,1);
500
501         /* calculate firmware CRC */
502         for (position = 0; position < fw->size; position++) {
503                 crc = nxt200x_crc(crc, fw->data[position]);
504         }
505
506         buf[0] = rambase >> 8;
507         buf[1] = rambase & 0xFF;
508         buf[2] = 0x81;
509         /* write starting address */
510         nxt200x_writebytes(state,0x29,buf,3);
511
512         for (position = 0; position < fw->size;) {
513                 nxt200x_writebytes(state, 0x2C, &fw->data[position],
514                         fw->size-position > 255 ? 255 : fw->size-position);
515                 position += (fw->size-position > 255 ? 255 : fw->size-position);
516         }
517         buf[0] = crc >> 8;
518         buf[1] = crc & 0xFF;
519
520         dprintk("firmware crc is 0x%02X 0x%02X\n", buf[0], buf[1]);
521
522         /* write crc */
523         nxt200x_writebytes(state, 0x2C, buf,2);
524
525         /* do a read to stop things */
526         nxt200x_readbytes(state, 0x2C, buf, 1);
527
528         /* set transfer mode to complete */
529         buf[0] = 0x80;
530         nxt200x_writebytes(state, 0x2B, buf,1);
531
532         return 0;
533 };
534
535 static int nxt200x_setup_frontend_parameters(struct dvb_frontend *fe)
536 {
537         struct dtv_frontend_properties *p = &fe->dtv_property_cache;
538         struct nxt200x_state* state = fe->demodulator_priv;
539         u8 buf[5];
540
541         /* stop the micro first */
542         nxt200x_microcontroller_stop(state);
543
544         if (state->demod_chip == NXT2004) {
545                 /* make sure demod is set to digital */
546                 buf[0] = 0x04;
547                 nxt200x_writebytes(state, 0x14, buf, 1);
548                 buf[0] = 0x00;
549                 nxt200x_writebytes(state, 0x17, buf, 1);
550         }
551
552         /* set additional params */
553         switch (p->modulation) {
554                 case QAM_64:
555                 case QAM_256:
556                         /* Set punctured clock for QAM */
557                         /* This is just a guess since I am unable to test it */
558                         if (state->config->set_ts_params)
559                                 state->config->set_ts_params(fe, 1);
560                         break;
561                 case VSB_8:
562                         /* Set non-punctured clock for VSB */
563                         if (state->config->set_ts_params)
564                                 state->config->set_ts_params(fe, 0);
565                         break;
566                 default:
567                         return -EINVAL;
568                         break;
569         }
570
571         if (fe->ops.tuner_ops.calc_regs) {
572                 /* get tuning information */
573                 fe->ops.tuner_ops.calc_regs(fe, buf, 5);
574
575                 /* write frequency information */
576                 nxt200x_writetuner(state, buf);
577         }
578
579         /* reset the agc now that tuning has been completed */
580         nxt200x_agc_reset(state);
581
582         /* set target power level */
583         switch (p->modulation) {
584                 case QAM_64:
585                 case QAM_256:
586                         buf[0] = 0x74;
587                         break;
588                 case VSB_8:
589                         buf[0] = 0x70;
590                         break;
591                 default:
592                         return -EINVAL;
593                         break;
594         }
595         nxt200x_writebytes(state, 0x42, buf, 1);
596
597         /* configure sdm */
598         switch (state->demod_chip) {
599                 case NXT2002:
600                         buf[0] = 0x87;
601                         break;
602                 case NXT2004:
603                         buf[0] = 0x07;
604                         break;
605                 default:
606                         return -EINVAL;
607                         break;
608         }
609         nxt200x_writebytes(state, 0x57, buf, 1);
610
611         /* write sdm1 input */
612         buf[0] = 0x10;
613         buf[1] = 0x00;
614         switch (state->demod_chip) {
615                 case NXT2002:
616                         nxt200x_writereg_multibyte(state, 0x58, buf, 2);
617                         break;
618                 case NXT2004:
619                         nxt200x_writebytes(state, 0x58, buf, 2);
620                         break;
621                 default:
622                         return -EINVAL;
623                         break;
624         }
625
626         /* write sdmx input */
627         switch (p->modulation) {
628                 case QAM_64:
629                                 buf[0] = 0x68;
630                                 break;
631                 case QAM_256:
632                                 buf[0] = 0x64;
633                                 break;
634                 case VSB_8:
635                                 buf[0] = 0x60;
636                                 break;
637                 default:
638                                 return -EINVAL;
639                                 break;
640         }
641         buf[1] = 0x00;
642         switch (state->demod_chip) {
643                 case NXT2002:
644                         nxt200x_writereg_multibyte(state, 0x5C, buf, 2);
645                         break;
646                 case NXT2004:
647                         nxt200x_writebytes(state, 0x5C, buf, 2);
648                         break;
649                 default:
650                         return -EINVAL;
651                         break;
652         }
653
654         /* write adc power lpf fc */
655         buf[0] = 0x05;
656         nxt200x_writebytes(state, 0x43, buf, 1);
657
658         if (state->demod_chip == NXT2004) {
659                 /* write ??? */
660                 buf[0] = 0x00;
661                 buf[1] = 0x00;
662                 nxt200x_writebytes(state, 0x46, buf, 2);
663         }
664
665         /* write accumulator2 input */
666         buf[0] = 0x80;
667         buf[1] = 0x00;
668         switch (state->demod_chip) {
669                 case NXT2002:
670                         nxt200x_writereg_multibyte(state, 0x4B, buf, 2);
671                         break;
672                 case NXT2004:
673                         nxt200x_writebytes(state, 0x4B, buf, 2);
674                         break;
675                 default:
676                         return -EINVAL;
677                         break;
678         }
679
680         /* write kg1 */
681         buf[0] = 0x00;
682         nxt200x_writebytes(state, 0x4D, buf, 1);
683
684         /* write sdm12 lpf fc */
685         buf[0] = 0x44;
686         nxt200x_writebytes(state, 0x55, buf, 1);
687
688         /* write agc control reg */
689         buf[0] = 0x04;
690         nxt200x_writebytes(state, 0x41, buf, 1);
691
692         if (state->demod_chip == NXT2004) {
693                 nxt200x_readreg_multibyte(state, 0x80, buf, 1);
694                 buf[0] = 0x24;
695                 nxt200x_writereg_multibyte(state, 0x80, buf, 1);
696
697                 /* soft reset? */
698                 nxt200x_readreg_multibyte(state, 0x08, buf, 1);
699                 buf[0] = 0x10;
700                 nxt200x_writereg_multibyte(state, 0x08, buf, 1);
701                 nxt200x_readreg_multibyte(state, 0x08, buf, 1);
702                 buf[0] = 0x00;
703                 nxt200x_writereg_multibyte(state, 0x08, buf, 1);
704
705                 nxt200x_readreg_multibyte(state, 0x80, buf, 1);
706                 buf[0] = 0x04;
707                 nxt200x_writereg_multibyte(state, 0x80, buf, 1);
708                 buf[0] = 0x00;
709                 nxt200x_writereg_multibyte(state, 0x81, buf, 1);
710                 buf[0] = 0x80; buf[1] = 0x00; buf[2] = 0x00;
711                 nxt200x_writereg_multibyte(state, 0x82, buf, 3);
712                 nxt200x_readreg_multibyte(state, 0x88, buf, 1);
713                 buf[0] = 0x11;
714                 nxt200x_writereg_multibyte(state, 0x88, buf, 1);
715                 nxt200x_readreg_multibyte(state, 0x80, buf, 1);
716                 buf[0] = 0x44;
717                 nxt200x_writereg_multibyte(state, 0x80, buf, 1);
718         }
719
720         /* write agc ucgp0 */
721         switch (p->modulation) {
722                 case QAM_64:
723                                 buf[0] = 0x02;
724                                 break;
725                 case QAM_256:
726                                 buf[0] = 0x03;
727                                 break;
728                 case VSB_8:
729                                 buf[0] = 0x00;
730                                 break;
731                 default:
732                                 return -EINVAL;
733                                 break;
734         }
735         nxt200x_writebytes(state, 0x30, buf, 1);
736
737         /* write agc control reg */
738         buf[0] = 0x00;
739         nxt200x_writebytes(state, 0x41, buf, 1);
740
741         /* write accumulator2 input */
742         buf[0] = 0x80;
743         buf[1] = 0x00;
744         switch (state->demod_chip) {
745                 case NXT2002:
746                         nxt200x_writereg_multibyte(state, 0x49, buf, 2);
747                         nxt200x_writereg_multibyte(state, 0x4B, buf, 2);
748                         break;
749                 case NXT2004:
750                         nxt200x_writebytes(state, 0x49, buf, 2);
751                         nxt200x_writebytes(state, 0x4B, buf, 2);
752                         break;
753                 default:
754                         return -EINVAL;
755                         break;
756         }
757
758         /* write agc control reg */
759         buf[0] = 0x04;
760         nxt200x_writebytes(state, 0x41, buf, 1);
761
762         nxt200x_microcontroller_start(state);
763
764         if (state->demod_chip == NXT2004) {
765                 nxt2004_microcontroller_init(state);
766
767                 /* ???? */
768                 buf[0] = 0xF0;
769                 buf[1] = 0x00;
770                 nxt200x_writebytes(state, 0x5C, buf, 2);
771         }
772
773         /* adjacent channel detection should be done here, but I don't
774         have any stations with this need so I cannot test it */
775
776         return 0;
777 }
778
779 static int nxt200x_read_status(struct dvb_frontend *fe, enum fe_status *status)
780 {
781         struct nxt200x_state* state = fe->demodulator_priv;
782         u8 lock;
783         nxt200x_readbytes(state, 0x31, &lock, 1);
784
785         *status = 0;
786         if (lock & 0x20) {
787                 *status |= FE_HAS_SIGNAL;
788                 *status |= FE_HAS_CARRIER;
789                 *status |= FE_HAS_VITERBI;
790                 *status |= FE_HAS_SYNC;
791                 *status |= FE_HAS_LOCK;
792         }
793         return 0;
794 }
795
796 static int nxt200x_read_ber(struct dvb_frontend* fe, u32* ber)
797 {
798         struct nxt200x_state* state = fe->demodulator_priv;
799         u8 b[3];
800
801         nxt200x_readreg_multibyte(state, 0xE6, b, 3);
802
803         *ber = ((b[0] << 8) + b[1]) * 8;
804
805         return 0;
806 }
807
808 static int nxt200x_read_signal_strength(struct dvb_frontend* fe, u16* strength)
809 {
810         struct nxt200x_state* state = fe->demodulator_priv;
811         u8 b[2];
812         u16 temp = 0;
813
814         /* setup to read cluster variance */
815         b[0] = 0x00;
816         nxt200x_writebytes(state, 0xA1, b, 1);
817
818         /* get multreg val */
819         nxt200x_readreg_multibyte(state, 0xA6, b, 2);
820
821         temp = (b[0] << 8) | b[1];
822         *strength = ((0x7FFF - temp) & 0x0FFF) * 16;
823
824         return 0;
825 }
826
827 static int nxt200x_read_snr(struct dvb_frontend* fe, u16* snr)
828 {
829
830         struct nxt200x_state* state = fe->demodulator_priv;
831         u8 b[2];
832         u16 temp = 0, temp2;
833         u32 snrdb = 0;
834
835         /* setup to read cluster variance */
836         b[0] = 0x00;
837         nxt200x_writebytes(state, 0xA1, b, 1);
838
839         /* get multreg val from 0xA6 */
840         nxt200x_readreg_multibyte(state, 0xA6, b, 2);
841
842         temp = (b[0] << 8) | b[1];
843         temp2 = 0x7FFF - temp;
844
845         /* snr will be in db */
846         if (temp2 > 0x7F00)
847                 snrdb = 1000*24 + ( 1000*(30-24) * ( temp2 - 0x7F00 ) / ( 0x7FFF - 0x7F00 ) );
848         else if (temp2 > 0x7EC0)
849                 snrdb = 1000*18 + ( 1000*(24-18) * ( temp2 - 0x7EC0 ) / ( 0x7F00 - 0x7EC0 ) );
850         else if (temp2 > 0x7C00)
851                 snrdb = 1000*12 + ( 1000*(18-12) * ( temp2 - 0x7C00 ) / ( 0x7EC0 - 0x7C00 ) );
852         else
853                 snrdb = 1000*0 + ( 1000*(12-0) * ( temp2 - 0 ) / ( 0x7C00 - 0 ) );
854
855         /* the value reported back from the frontend will be FFFF=32db 0000=0db */
856         *snr = snrdb * (0xFFFF/32000);
857
858         return 0;
859 }
860
861 static int nxt200x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
862 {
863         struct nxt200x_state* state = fe->demodulator_priv;
864         u8 b[3];
865
866         nxt200x_readreg_multibyte(state, 0xE6, b, 3);
867         *ucblocks = b[2];
868
869         return 0;
870 }
871
872 static int nxt200x_sleep(struct dvb_frontend* fe)
873 {
874         return 0;
875 }
876
877 static int nxt2002_init(struct dvb_frontend* fe)
878 {
879         struct nxt200x_state* state = fe->demodulator_priv;
880         const struct firmware *fw;
881         int ret;
882         u8 buf[2];
883
884         /* request the firmware, this will block until someone uploads it */
885         pr_debug("%s: Waiting for firmware upload (%s)...\n",
886                  __func__, NXT2002_DEFAULT_FIRMWARE);
887         ret = request_firmware(&fw, NXT2002_DEFAULT_FIRMWARE,
888                                state->i2c->dev.parent);
889         pr_debug("%s: Waiting for firmware upload(2)...\n", __func__);
890         if (ret) {
891                 pr_err("%s: No firmware uploaded (timeout or file not found?)\n",
892                        __func__);
893                 return ret;
894         }
895
896         ret = nxt2002_load_firmware(fe, fw);
897         release_firmware(fw);
898         if (ret) {
899                 pr_err("%s: Writing firmware to device failed\n", __func__);
900                 return ret;
901         }
902         pr_info("%s: Firmware upload complete\n", __func__);
903
904         /* Put the micro into reset */
905         nxt200x_microcontroller_stop(state);
906
907         /* ensure transfer is complete */
908         buf[0]=0x00;
909         nxt200x_writebytes(state, 0x2B, buf, 1);
910
911         /* Put the micro into reset for real this time */
912         nxt200x_microcontroller_stop(state);
913
914         /* soft reset everything (agc,frontend,eq,fec)*/
915         buf[0] = 0x0F;
916         nxt200x_writebytes(state, 0x08, buf, 1);
917         buf[0] = 0x00;
918         nxt200x_writebytes(state, 0x08, buf, 1);
919
920         /* write agc sdm configure */
921         buf[0] = 0xF1;
922         nxt200x_writebytes(state, 0x57, buf, 1);
923
924         /* write mod output format */
925         buf[0] = 0x20;
926         nxt200x_writebytes(state, 0x09, buf, 1);
927
928         /* write fec mpeg mode */
929         buf[0] = 0x7E;
930         buf[1] = 0x00;
931         nxt200x_writebytes(state, 0xE9, buf, 2);
932
933         /* write mux selection */
934         buf[0] = 0x00;
935         nxt200x_writebytes(state, 0xCC, buf, 1);
936
937         return 0;
938 }
939
940 static int nxt2004_init(struct dvb_frontend* fe)
941 {
942         struct nxt200x_state* state = fe->demodulator_priv;
943         const struct firmware *fw;
944         int ret;
945         u8 buf[3];
946
947         /* ??? */
948         buf[0]=0x00;
949         nxt200x_writebytes(state, 0x1E, buf, 1);
950
951         /* request the firmware, this will block until someone uploads it */
952         pr_debug("%s: Waiting for firmware upload (%s)...\n",
953                  __func__, NXT2004_DEFAULT_FIRMWARE);
954         ret = request_firmware(&fw, NXT2004_DEFAULT_FIRMWARE,
955                                state->i2c->dev.parent);
956         pr_debug("%s: Waiting for firmware upload(2)...\n", __func__);
957         if (ret) {
958                 pr_err("%s: No firmware uploaded (timeout or file not found?)\n",
959                        __func__);
960                 return ret;
961         }
962
963         ret = nxt2004_load_firmware(fe, fw);
964         release_firmware(fw);
965         if (ret) {
966                 pr_err("%s: Writing firmware to device failed\n", __func__);
967                 return ret;
968         }
969         pr_info("%s: Firmware upload complete\n", __func__);
970
971         /* ensure transfer is complete */
972         buf[0] = 0x01;
973         nxt200x_writebytes(state, 0x19, buf, 1);
974
975         nxt2004_microcontroller_init(state);
976         nxt200x_microcontroller_stop(state);
977         nxt200x_microcontroller_stop(state);
978         nxt2004_microcontroller_init(state);
979         nxt200x_microcontroller_stop(state);
980
981         /* soft reset everything (agc,frontend,eq,fec)*/
982         buf[0] = 0xFF;
983         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
984         buf[0] = 0x00;
985         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
986
987         /* write agc sdm configure */
988         buf[0] = 0xD7;
989         nxt200x_writebytes(state, 0x57, buf, 1);
990
991         /* ???*/
992         buf[0] = 0x07;
993         buf[1] = 0xfe;
994         nxt200x_writebytes(state, 0x35, buf, 2);
995         buf[0] = 0x12;
996         nxt200x_writebytes(state, 0x34, buf, 1);
997         buf[0] = 0x80;
998         nxt200x_writebytes(state, 0x21, buf, 1);
999
1000         /* ???*/
1001         buf[0] = 0x21;
1002         nxt200x_writebytes(state, 0x0A, buf, 1);
1003
1004         /* ???*/
1005         buf[0] = 0x01;
1006         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1007
1008         /* write fec mpeg mode */
1009         buf[0] = 0x7E;
1010         buf[1] = 0x00;
1011         nxt200x_writebytes(state, 0xE9, buf, 2);
1012
1013         /* write mux selection */
1014         buf[0] = 0x00;
1015         nxt200x_writebytes(state, 0xCC, buf, 1);
1016
1017         /* ???*/
1018         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1019         buf[0] = 0x00;
1020         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1021
1022         /* soft reset? */
1023         nxt200x_readreg_multibyte(state, 0x08, buf, 1);
1024         buf[0] = 0x10;
1025         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
1026         nxt200x_readreg_multibyte(state, 0x08, buf, 1);
1027         buf[0] = 0x00;
1028         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
1029
1030         /* ???*/
1031         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1032         buf[0] = 0x01;
1033         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1034         buf[0] = 0x70;
1035         nxt200x_writereg_multibyte(state, 0x81, buf, 1);
1036         buf[0] = 0x31; buf[1] = 0x5E; buf[2] = 0x66;
1037         nxt200x_writereg_multibyte(state, 0x82, buf, 3);
1038
1039         nxt200x_readreg_multibyte(state, 0x88, buf, 1);
1040         buf[0] = 0x11;
1041         nxt200x_writereg_multibyte(state, 0x88, buf, 1);
1042         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1043         buf[0] = 0x40;
1044         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1045
1046         nxt200x_readbytes(state, 0x10, buf, 1);
1047         buf[0] = 0x10;
1048         nxt200x_writebytes(state, 0x10, buf, 1);
1049         nxt200x_readbytes(state, 0x0A, buf, 1);
1050         buf[0] = 0x21;
1051         nxt200x_writebytes(state, 0x0A, buf, 1);
1052
1053         nxt2004_microcontroller_init(state);
1054
1055         buf[0] = 0x21;
1056         nxt200x_writebytes(state, 0x0A, buf, 1);
1057         buf[0] = 0x7E;
1058         nxt200x_writebytes(state, 0xE9, buf, 1);
1059         buf[0] = 0x00;
1060         nxt200x_writebytes(state, 0xEA, buf, 1);
1061
1062         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1063         buf[0] = 0x00;
1064         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1065         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1066         buf[0] = 0x00;
1067         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1068
1069         /* soft reset? */
1070         nxt200x_readreg_multibyte(state, 0x08, buf, 1);
1071         buf[0] = 0x10;
1072         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
1073         nxt200x_readreg_multibyte(state, 0x08, buf, 1);
1074         buf[0] = 0x00;
1075         nxt200x_writereg_multibyte(state, 0x08, buf, 1);
1076
1077         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1078         buf[0] = 0x04;
1079         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1080         buf[0] = 0x00;
1081         nxt200x_writereg_multibyte(state, 0x81, buf, 1);
1082         buf[0] = 0x80; buf[1] = 0x00; buf[2] = 0x00;
1083         nxt200x_writereg_multibyte(state, 0x82, buf, 3);
1084
1085         nxt200x_readreg_multibyte(state, 0x88, buf, 1);
1086         buf[0] = 0x11;
1087         nxt200x_writereg_multibyte(state, 0x88, buf, 1);
1088
1089         nxt200x_readreg_multibyte(state, 0x80, buf, 1);
1090         buf[0] = 0x44;
1091         nxt200x_writereg_multibyte(state, 0x80, buf, 1);
1092
1093         /* initialize tuner */
1094         nxt200x_readbytes(state, 0x10, buf, 1);
1095         buf[0] = 0x12;
1096         nxt200x_writebytes(state, 0x10, buf, 1);
1097         buf[0] = 0x04;
1098         nxt200x_writebytes(state, 0x13, buf, 1);
1099         buf[0] = 0x00;
1100         nxt200x_writebytes(state, 0x16, buf, 1);
1101         buf[0] = 0x04;
1102         nxt200x_writebytes(state, 0x14, buf, 1);
1103         buf[0] = 0x00;
1104         nxt200x_writebytes(state, 0x14, buf, 1);
1105         nxt200x_writebytes(state, 0x17, buf, 1);
1106         nxt200x_writebytes(state, 0x14, buf, 1);
1107         nxt200x_writebytes(state, 0x17, buf, 1);
1108
1109         return 0;
1110 }
1111
1112 static int nxt200x_init(struct dvb_frontend* fe)
1113 {
1114         struct nxt200x_state* state = fe->demodulator_priv;
1115         int ret = 0;
1116
1117         if (!state->initialised) {
1118                 switch (state->demod_chip) {
1119                         case NXT2002:
1120                                 ret = nxt2002_init(fe);
1121                                 break;
1122                         case NXT2004:
1123                                 ret = nxt2004_init(fe);
1124                                 break;
1125                         default:
1126                                 return -EINVAL;
1127                                 break;
1128                 }
1129                 state->initialised = 1;
1130         }
1131         return ret;
1132 }
1133
1134 static int nxt200x_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
1135 {
1136         fesettings->min_delay_ms = 500;
1137         fesettings->step_size = 0;
1138         fesettings->max_drift = 0;
1139         return 0;
1140 }
1141
1142 static void nxt200x_release(struct dvb_frontend* fe)
1143 {
1144         struct nxt200x_state* state = fe->demodulator_priv;
1145         kfree(state);
1146 }
1147
1148 static const struct dvb_frontend_ops nxt200x_ops;
1149
1150 struct dvb_frontend* nxt200x_attach(const struct nxt200x_config* config,
1151                                    struct i2c_adapter* i2c)
1152 {
1153         struct nxt200x_state* state = NULL;
1154         u8 buf [] = {0,0,0,0,0};
1155
1156         /* allocate memory for the internal state */
1157         state = kzalloc(sizeof(struct nxt200x_state), GFP_KERNEL);
1158         if (state == NULL)
1159                 goto error;
1160
1161         /* setup the state */
1162         state->config = config;
1163         state->i2c = i2c;
1164         state->initialised = 0;
1165
1166         /* read card id */
1167         nxt200x_readbytes(state, 0x00, buf, 5);
1168         dprintk("NXT info: %*ph\n", 5, buf);
1169
1170         /* set demod chip */
1171         switch (buf[0]) {
1172                 case 0x04:
1173                         state->demod_chip = NXT2002;
1174                         pr_info("NXT2002 Detected\n");
1175                         break;
1176                 case 0x05:
1177                         state->demod_chip = NXT2004;
1178                         pr_info("NXT2004 Detected\n");
1179                         break;
1180                 default:
1181                         goto error;
1182         }
1183
1184         /* make sure demod chip is supported */
1185         switch (state->demod_chip) {
1186                 case NXT2002:
1187                         if (buf[0] != 0x04) goto error;         /* device id */
1188                         if (buf[1] != 0x02) goto error;         /* fab id */
1189                         if (buf[2] != 0x11) goto error;         /* month */
1190                         if (buf[3] != 0x20) goto error;         /* year msb */
1191                         if (buf[4] != 0x00) goto error;         /* year lsb */
1192                         break;
1193                 case NXT2004:
1194                         if (buf[0] != 0x05) goto error;         /* device id */
1195                         break;
1196                 default:
1197                         goto error;
1198         }
1199
1200         /* create dvb_frontend */
1201         memcpy(&state->frontend.ops, &nxt200x_ops, sizeof(struct dvb_frontend_ops));
1202         state->frontend.demodulator_priv = state;
1203         return &state->frontend;
1204
1205 error:
1206         kfree(state);
1207         pr_err("Unknown/Unsupported NXT chip: %*ph\n", 5, buf);
1208         return NULL;
1209 }
1210
1211 static const struct dvb_frontend_ops nxt200x_ops = {
1212         .delsys = { SYS_ATSC, SYS_DVBC_ANNEX_B },
1213         .info = {
1214                 .name = "Nextwave NXT200X VSB/QAM frontend",
1215                 .frequency_min =  54000000,
1216                 .frequency_max = 860000000,
1217                 .frequency_stepsize = 166666,   /* stepsize is just a guess */
1218                 .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1219                         FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1220                         FE_CAN_8VSB | FE_CAN_QAM_64 | FE_CAN_QAM_256
1221         },
1222
1223         .release = nxt200x_release,
1224
1225         .init = nxt200x_init,
1226         .sleep = nxt200x_sleep,
1227
1228         .set_frontend = nxt200x_setup_frontend_parameters,
1229         .get_tune_settings = nxt200x_get_tune_settings,
1230
1231         .read_status = nxt200x_read_status,
1232         .read_ber = nxt200x_read_ber,
1233         .read_signal_strength = nxt200x_read_signal_strength,
1234         .read_snr = nxt200x_read_snr,
1235         .read_ucblocks = nxt200x_read_ucblocks,
1236 };
1237
1238 module_param(debug, int, 0644);
1239 MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
1240
1241 MODULE_DESCRIPTION("NXT200X (ATSC 8VSB & ITU-T J.83 AnnexB 64/256 QAM) Demodulator Driver");
1242 MODULE_AUTHOR("Kirk Lapray, Michael Krufky, Jean-Francois Thibert, and Taylor Jacob");
1243 MODULE_LICENSE("GPL");
1244
1245 EXPORT_SYMBOL(nxt200x_attach);
1246