nxt2k.c revision 1.1 1 1.1 jakllsch /* $NetBSD: nxt2k.c,v 1.1 2011/07/11 00:30:23 jakllsch Exp $ */
2 1.1 jakllsch
3 1.1 jakllsch /*
4 1.1 jakllsch * Copyright (c) 2008, 2011 Jonathan A. Kollasch
5 1.1 jakllsch * All rights reserved.
6 1.1 jakllsch *
7 1.1 jakllsch * Redistribution and use in source and binary forms, with or without
8 1.1 jakllsch * modification, are permitted provided that the following conditions
9 1.1 jakllsch * are met:
10 1.1 jakllsch * 1. Redistributions of source code must retain the above copyright
11 1.1 jakllsch * notice, this list of conditions and the following disclaimer.
12 1.1 jakllsch * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jakllsch * notice, this list of conditions and the following disclaimer in the
14 1.1 jakllsch * documentation and/or other materials provided with the distribution.
15 1.1 jakllsch *
16 1.1 jakllsch * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
17 1.1 jakllsch * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 jakllsch * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 jakllsch * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
20 1.1 jakllsch * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
21 1.1 jakllsch * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
22 1.1 jakllsch * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
23 1.1 jakllsch * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 1.1 jakllsch * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
25 1.1 jakllsch * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
26 1.1 jakllsch * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 1.1 jakllsch */
28 1.1 jakllsch
29 1.1 jakllsch #include <sys/cdefs.h>
30 1.1 jakllsch __KERNEL_RCSID(0, "$NetBSD: nxt2k.c,v 1.1 2011/07/11 00:30:23 jakllsch Exp $");
31 1.1 jakllsch
32 1.1 jakllsch #include <sys/param.h>
33 1.1 jakllsch #include <sys/kernel.h>
34 1.1 jakllsch #include <sys/systm.h>
35 1.1 jakllsch #include <sys/device.h>
36 1.1 jakllsch #include <sys/kmem.h>
37 1.1 jakllsch #include <sys/condvar.h>
38 1.1 jakllsch #include <sys/mutex.h>
39 1.1 jakllsch
40 1.1 jakllsch #include <dev/firmload.h>
41 1.1 jakllsch
42 1.1 jakllsch #include <dev/i2c/nxt2kvar.h>
43 1.1 jakllsch
44 1.1 jakllsch struct nxt2k {
45 1.1 jakllsch device_t parent;
46 1.1 jakllsch i2c_tag_t tag;
47 1.1 jakllsch i2c_addr_t addr;
48 1.1 jakllsch kcondvar_t cv;
49 1.1 jakllsch kmutex_t mtx;
50 1.1 jakllsch bool loaded; /* firmware is loaded? */
51 1.1 jakllsch };
52 1.1 jakllsch
53 1.1 jakllsch static int nxt2k_init(struct nxt2k *);
54 1.1 jakllsch
55 1.1 jakllsch static int nxt2k_writedata(struct nxt2k *, uint8_t, uint8_t *, size_t);
56 1.1 jakllsch static int nxt2k_readdata(struct nxt2k *, uint8_t, uint8_t *, size_t);
57 1.1 jakllsch static int nxt2k_writereg(struct nxt2k *, uint8_t, uint8_t *, size_t);
58 1.1 jakllsch static int nxt2k_readreg(struct nxt2k*, uint8_t, uint8_t *, size_t);
59 1.1 jakllsch
60 1.1 jakllsch static int nxt2k4_init(struct nxt2k *);
61 1.1 jakllsch static bool nxt2k4_load_firmware(struct nxt2k *);
62 1.1 jakllsch static void nxt2k4_mc_init(struct nxt2k *);
63 1.1 jakllsch static void nxt2k_mc_start(struct nxt2k *);
64 1.1 jakllsch static void nxt2k_mc_stop(struct nxt2k *);
65 1.1 jakllsch static void nxt2k_agc_reset(struct nxt2k *);
66 1.1 jakllsch static uint16_t nxt2k_crc_ccit(uint16_t, uint8_t);
67 1.1 jakllsch
68 1.1 jakllsch static int
69 1.1 jakllsch nxt2k_writedata(struct nxt2k *nxt, uint8_t reg, uint8_t *data, size_t len)
70 1.1 jakllsch {
71 1.1 jakllsch uint8_t buffer[384];
72 1.1 jakllsch int error;
73 1.1 jakllsch
74 1.1 jakllsch KASSERT((len + 1) <= 384);
75 1.1 jakllsch
76 1.1 jakllsch if (iic_acquire_bus(nxt->tag, I2C_F_POLL) != 0)
77 1.1 jakllsch return false;
78 1.1 jakllsch
79 1.1 jakllsch buffer[0] = reg;
80 1.1 jakllsch memcpy(&buffer[1], data, len);
81 1.1 jakllsch
82 1.1 jakllsch error = iic_exec(nxt->tag, I2C_OP_WRITE_WITH_STOP, nxt->addr,
83 1.1 jakllsch buffer, len + 1, NULL, 0, I2C_F_POLL);
84 1.1 jakllsch
85 1.1 jakllsch iic_release_bus(nxt->tag, I2C_F_POLL);
86 1.1 jakllsch
87 1.1 jakllsch return error;
88 1.1 jakllsch }
89 1.1 jakllsch
90 1.1 jakllsch static int
91 1.1 jakllsch nxt2k_readdata(struct nxt2k *nxt, uint8_t reg, uint8_t *data, size_t len)
92 1.1 jakllsch {
93 1.1 jakllsch int error;
94 1.1 jakllsch
95 1.1 jakllsch if (iic_acquire_bus(nxt->tag, I2C_F_POLL) != 0)
96 1.1 jakllsch return false;
97 1.1 jakllsch
98 1.1 jakllsch error = iic_exec(nxt->tag, I2C_OP_READ_WITH_STOP, nxt->addr,
99 1.1 jakllsch ®, 1, data, len, I2C_F_POLL);
100 1.1 jakllsch
101 1.1 jakllsch iic_release_bus(nxt->tag, I2C_F_POLL);
102 1.1 jakllsch
103 1.1 jakllsch return error;
104 1.1 jakllsch }
105 1.1 jakllsch
106 1.1 jakllsch static int
107 1.1 jakllsch nxt2k_writereg(struct nxt2k *nxt, uint8_t reg, uint8_t *data, size_t len)
108 1.1 jakllsch {
109 1.1 jakllsch uint8_t attr, len2, buf;
110 1.1 jakllsch
111 1.1 jakllsch nxt2k_writedata(nxt, 0x35, ®, 1);
112 1.1 jakllsch
113 1.1 jakllsch nxt2k_writedata(nxt, 0x36, data, len);
114 1.1 jakllsch
115 1.1 jakllsch attr = 0x02;
116 1.1 jakllsch if (reg & 0x80) {
117 1.1 jakllsch attr = attr << 1;
118 1.1 jakllsch if (reg & 0x04)
119 1.1 jakllsch attr = attr >> 1;
120 1.1 jakllsch }
121 1.1 jakllsch len2 = ((attr << 4) | 0x10) | len;
122 1.1 jakllsch buf = 0x80;
123 1.1 jakllsch
124 1.1 jakllsch nxt2k_writedata(nxt, 0x34, &len2, 1);
125 1.1 jakllsch
126 1.1 jakllsch nxt2k_writedata(nxt, 0x21, &buf, 1);
127 1.1 jakllsch
128 1.1 jakllsch nxt2k_readdata(nxt, 0x21, &buf, 1);
129 1.1 jakllsch
130 1.1 jakllsch if (buf == 0)
131 1.1 jakllsch return 0;
132 1.1 jakllsch
133 1.1 jakllsch return -1;
134 1.1 jakllsch }
135 1.1 jakllsch
136 1.1 jakllsch static int
137 1.1 jakllsch nxt2k_readreg(struct nxt2k *nxt, uint8_t reg, uint8_t *data, size_t len)
138 1.1 jakllsch {
139 1.1 jakllsch uint8_t buf, len2, attr;
140 1.1 jakllsch int i;
141 1.1 jakllsch
142 1.1 jakllsch nxt2k_writedata(nxt, 0x35, ®, 1);
143 1.1 jakllsch
144 1.1 jakllsch attr = 0x02;
145 1.1 jakllsch if (reg & 0x80) {
146 1.1 jakllsch attr = attr << 1;
147 1.1 jakllsch if (reg & 0x04)
148 1.1 jakllsch attr = attr >> 1;
149 1.1 jakllsch }
150 1.1 jakllsch
151 1.1 jakllsch len2 = (attr << 4) | len;
152 1.1 jakllsch nxt2k_writedata(nxt, 0x34, &len2, 1);
153 1.1 jakllsch
154 1.1 jakllsch buf = 0x80;
155 1.1 jakllsch nxt2k_writedata(nxt, 0x21, &buf, 1);
156 1.1 jakllsch
157 1.1 jakllsch for(i = 0; i < len; i++) {
158 1.1 jakllsch nxt2k_readdata(nxt, 0x36+i, &data[i], 1);
159 1.1 jakllsch }
160 1.1 jakllsch
161 1.1 jakllsch return 0;
162 1.1 jakllsch }
163 1.1 jakllsch
164 1.1 jakllsch static void
165 1.1 jakllsch nxt2k_agc_reset(struct nxt2k *nxt)
166 1.1 jakllsch {
167 1.1 jakllsch uint8_t byte;
168 1.1 jakllsch nxt2k_readreg(nxt, 0x08, &byte, 1);
169 1.1 jakllsch byte = 0x08;
170 1.1 jakllsch nxt2k_writereg(nxt, 0x08, &byte, 1);
171 1.1 jakllsch byte = 0x00;
172 1.1 jakllsch nxt2k_writereg(nxt, 0x08, &byte, 1);
173 1.1 jakllsch return;
174 1.1 jakllsch }
175 1.1 jakllsch
176 1.1 jakllsch static void
177 1.1 jakllsch nxt2k_mc_stop(struct nxt2k *nxt)
178 1.1 jakllsch {
179 1.1 jakllsch int counter;
180 1.1 jakllsch uint8_t stopval, buf;
181 1.1 jakllsch
182 1.1 jakllsch /* 2k4 */
183 1.1 jakllsch stopval = 0x10;
184 1.1 jakllsch
185 1.1 jakllsch buf = 0x80;
186 1.1 jakllsch nxt2k_writedata(nxt, 0x22, &buf, 1);
187 1.1 jakllsch
188 1.1 jakllsch for(counter = 0; counter < 20; counter++) {
189 1.1 jakllsch nxt2k_readdata(nxt, 0x31, &buf, 1);
190 1.1 jakllsch if (buf & stopval)
191 1.1 jakllsch return;
192 1.1 jakllsch mutex_enter(&nxt->mtx);
193 1.1 jakllsch cv_timedwait(&nxt->cv, &nxt->mtx, mstohz(10));
194 1.1 jakllsch mutex_exit(&nxt->mtx);
195 1.1 jakllsch }
196 1.1 jakllsch
197 1.1 jakllsch printf("%s timeout\n", __func__);
198 1.1 jakllsch
199 1.1 jakllsch return;
200 1.1 jakllsch }
201 1.1 jakllsch
202 1.1 jakllsch static void
203 1.1 jakllsch nxt2k_mc_start(struct nxt2k *nxt)
204 1.1 jakllsch {
205 1.1 jakllsch uint8_t buf;
206 1.1 jakllsch
207 1.1 jakllsch buf = 0x00;
208 1.1 jakllsch nxt2k_writedata(nxt, 0x22, &buf, 1);
209 1.1 jakllsch }
210 1.1 jakllsch
211 1.1 jakllsch static void
212 1.1 jakllsch nxt2k4_mc_init(struct nxt2k *nxt)
213 1.1 jakllsch {
214 1.1 jakllsch uint8_t byte;
215 1.1 jakllsch uint8_t data[] = {0x01, 0x23, 0x45, 0x67, 0x89, 0xAB, 0xCD, 0xEF, 0xC0};
216 1.1 jakllsch int counter;
217 1.1 jakllsch
218 1.1 jakllsch byte = 0x00;
219 1.1 jakllsch nxt2k_writedata(nxt, 0x2b, &byte, 1);
220 1.1 jakllsch byte = 0x70;
221 1.1 jakllsch nxt2k_writedata(nxt, 0x34, &byte, 1);
222 1.1 jakllsch byte = 0x04;
223 1.1 jakllsch nxt2k_writedata(nxt, 0x35, &byte, 1);
224 1.1 jakllsch
225 1.1 jakllsch nxt2k_writedata(nxt, 0x36, data, 9);
226 1.1 jakllsch
227 1.1 jakllsch byte = 0x80;
228 1.1 jakllsch nxt2k_writedata(nxt, 0x21, &byte, 1);
229 1.1 jakllsch
230 1.1 jakllsch for(counter = 0; counter < 20; counter++) {
231 1.1 jakllsch nxt2k_readdata(nxt, 0x21, &byte, 1);
232 1.1 jakllsch if ( byte == 0 )
233 1.1 jakllsch return;
234 1.1 jakllsch mutex_enter(&nxt->mtx);
235 1.1 jakllsch cv_timedwait(&nxt->cv, &nxt->mtx, mstohz(25));
236 1.1 jakllsch mutex_exit(&nxt->mtx);
237 1.1 jakllsch }
238 1.1 jakllsch
239 1.1 jakllsch printf("%s timeout\n", __func__);
240 1.1 jakllsch
241 1.1 jakllsch return;
242 1.1 jakllsch }
243 1.1 jakllsch
244 1.1 jakllsch /* CRC-CCIT */
245 1.1 jakllsch static uint16_t
246 1.1 jakllsch nxt2k_crc_ccit(uint16_t crc, uint8_t byte)
247 1.1 jakllsch {
248 1.1 jakllsch int i;
249 1.1 jakllsch uint16_t input;
250 1.1 jakllsch
251 1.1 jakllsch input = byte << 8;
252 1.1 jakllsch
253 1.1 jakllsch for(i = 0; i < 8; i++) {
254 1.1 jakllsch if ((crc ^ input) & 0x8000)
255 1.1 jakllsch crc = (crc << 1) ^ 0x1021;
256 1.1 jakllsch else
257 1.1 jakllsch crc = (crc << 1);
258 1.1 jakllsch input = input << 1;
259 1.1 jakllsch }
260 1.1 jakllsch return crc;
261 1.1 jakllsch }
262 1.1 jakllsch
263 1.1 jakllsch static bool
264 1.1 jakllsch nxt2k4_load_firmware(struct nxt2k *nxt)
265 1.1 jakllsch {
266 1.1 jakllsch firmware_handle_t fh;
267 1.1 jakllsch uint8_t *blob;
268 1.1 jakllsch size_t fwsize;
269 1.1 jakllsch size_t position;
270 1.1 jakllsch int error;
271 1.1 jakllsch uint16_t crc;
272 1.1 jakllsch
273 1.1 jakllsch error = firmware_open("nxt2k", "dvb-fe-nxt2004.fw", &fh);
274 1.1 jakllsch if (error != 0) {
275 1.1 jakllsch printf("nxt2k firmware_open fail %d\n", error);
276 1.1 jakllsch return 0;
277 1.1 jakllsch }
278 1.1 jakllsch
279 1.1 jakllsch fwsize = firmware_get_size(fh);
280 1.1 jakllsch printf("fwsize %zd\n", fwsize);
281 1.1 jakllsch blob = firmware_malloc(fwsize);
282 1.1 jakllsch if ( blob == NULL ) {
283 1.1 jakllsch printf("nxt2k firmware_malloc fail\n");
284 1.1 jakllsch firmware_close(fh);
285 1.1 jakllsch return -1;
286 1.1 jakllsch }
287 1.1 jakllsch
288 1.1 jakllsch error = firmware_read(fh, 0, blob, fwsize);
289 1.1 jakllsch if (error != 0) {
290 1.1 jakllsch printf("nxt2k firmware_read fail %d\n", error);
291 1.1 jakllsch firmware_free(blob, fwsize);
292 1.1 jakllsch firmware_close(fh);
293 1.1 jakllsch return -1;
294 1.1 jakllsch }
295 1.1 jakllsch
296 1.1 jakllsch /* calculate CRC */
297 1.1 jakllsch crc = 0;
298 1.1 jakllsch for(position = 0; position < fwsize; position++) {
299 1.1 jakllsch crc = nxt2k_crc_ccit(crc, blob[position]);
300 1.1 jakllsch }
301 1.1 jakllsch printf("nxt2k firmware crc is %02x\n", crc);
302 1.1 jakllsch
303 1.1 jakllsch uint16_t rambase;
304 1.1 jakllsch uint8_t buf[3];
305 1.1 jakllsch
306 1.1 jakllsch rambase = 0x1000;
307 1.1 jakllsch
308 1.1 jakllsch /* hold the micro in reset while loading firmware */
309 1.1 jakllsch buf[0] = 0x80;
310 1.1 jakllsch nxt2k_writedata(nxt, 0x2b, buf, 1);
311 1.1 jakllsch
312 1.1 jakllsch buf[0] = rambase >> 8;
313 1.1 jakllsch buf[1] = rambase & 0xFF;
314 1.1 jakllsch buf[2] = 0x81;
315 1.1 jakllsch /* write starting address */
316 1.1 jakllsch nxt2k_writedata(nxt, 0x29, buf, 3);
317 1.1 jakllsch
318 1.1 jakllsch position = 0;
319 1.1 jakllsch
320 1.1 jakllsch size_t xfercnt;
321 1.1 jakllsch
322 1.1 jakllsch while ( position < fwsize ) {
323 1.1 jakllsch xfercnt = fwsize - position > 255 ? 255 : fwsize - position;
324 1.1 jakllsch nxt2k_writedata(nxt, 0x2c, &blob[position], xfercnt);
325 1.1 jakllsch position += xfercnt;
326 1.1 jakllsch }
327 1.1 jakllsch
328 1.1 jakllsch /* write crc */
329 1.1 jakllsch buf[0] = crc >> 8;
330 1.1 jakllsch buf[1] = crc & 0xFF;
331 1.1 jakllsch nxt2k_writedata(nxt, 0x2c, buf, 2);
332 1.1 jakllsch
333 1.1 jakllsch /* do a read to stop things */
334 1.1 jakllsch nxt2k_readdata(nxt, 0x2c, buf, 1);
335 1.1 jakllsch
336 1.1 jakllsch /* set transfer mode to complete */
337 1.1 jakllsch buf[0] = 0x80;
338 1.1 jakllsch nxt2k_writedata(nxt, 0x2b, buf, 1);
339 1.1 jakllsch
340 1.1 jakllsch firmware_free(blob, fwsize);
341 1.1 jakllsch firmware_close(fh);
342 1.1 jakllsch
343 1.1 jakllsch return 1;
344 1.1 jakllsch }
345 1.1 jakllsch
346 1.1 jakllsch static int
347 1.1 jakllsch nxt2k4_init(struct nxt2k *nxt)
348 1.1 jakllsch {
349 1.1 jakllsch int success;
350 1.1 jakllsch uint8_t buf[3];
351 1.1 jakllsch
352 1.1 jakllsch buf[0] = 0x00;
353 1.1 jakllsch nxt2k_writedata(nxt, 0x1e, buf, 1);
354 1.1 jakllsch
355 1.1 jakllsch /* try to load firmware */
356 1.1 jakllsch nxt->loaded = nxt2k4_load_firmware(nxt);
357 1.1 jakllsch if (nxt->loaded == false)
358 1.1 jakllsch return ECANCELED;
359 1.1 jakllsch
360 1.1 jakllsch /* ensure transfer is complete */
361 1.1 jakllsch buf[0] = 0x01;
362 1.1 jakllsch nxt2k_writedata(nxt, 0x19, buf, 1);
363 1.1 jakllsch
364 1.1 jakllsch nxt2k4_mc_init(nxt);
365 1.1 jakllsch nxt2k_mc_stop(nxt);
366 1.1 jakllsch nxt2k_mc_stop(nxt);
367 1.1 jakllsch nxt2k4_mc_init(nxt);
368 1.1 jakllsch nxt2k_mc_stop(nxt);
369 1.1 jakllsch
370 1.1 jakllsch buf[0] = 0xff;
371 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
372 1.1 jakllsch buf[0] = 0x00;
373 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
374 1.1 jakllsch
375 1.1 jakllsch buf[0] = 0xD7;
376 1.1 jakllsch nxt2k_writedata(nxt, 0xd7, buf, 1);
377 1.1 jakllsch
378 1.1 jakllsch buf[0] = 0x07;
379 1.1 jakllsch buf[1] = 0xfe;
380 1.1 jakllsch nxt2k_writedata(nxt, 0x35, buf, 2);
381 1.1 jakllsch buf[0] = 0x12;
382 1.1 jakllsch nxt2k_writedata(nxt, 0x34, buf, 1);
383 1.1 jakllsch buf[0] = 0x80;
384 1.1 jakllsch nxt2k_writedata(nxt, 0x21, buf, 1);
385 1.1 jakllsch
386 1.1 jakllsch buf[0] = 0x21;
387 1.1 jakllsch nxt2k_writedata(nxt, 0x0a, buf, 1);
388 1.1 jakllsch
389 1.1 jakllsch buf[0] = 0x01;
390 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
391 1.1 jakllsch
392 1.1 jakllsch /* fec mpeg mode */
393 1.1 jakllsch buf[0] = 0x7E;
394 1.1 jakllsch buf[1] = 0x00;
395 1.1 jakllsch nxt2k_writedata(nxt, 0xe9, buf, 2);
396 1.1 jakllsch
397 1.1 jakllsch /* mux selection */
398 1.1 jakllsch buf[0] = 0x00;
399 1.1 jakllsch nxt2k_writedata(nxt, 0xcc, buf, 1);
400 1.1 jakllsch
401 1.1 jakllsch /* */
402 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
403 1.1 jakllsch buf[0] = 0x00;
404 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
405 1.1 jakllsch
406 1.1 jakllsch /* soft reset? */
407 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
408 1.1 jakllsch buf[0] = 0x10;
409 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
410 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
411 1.1 jakllsch buf[0] = 0x00;
412 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
413 1.1 jakllsch
414 1.1 jakllsch /* */
415 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
416 1.1 jakllsch buf[0] = 0x01;
417 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
418 1.1 jakllsch buf[0] = 0x70;
419 1.1 jakllsch nxt2k_writereg(nxt, 0x81, buf, 1);
420 1.1 jakllsch buf[0] = 0x31; buf[1] = 0x5E; buf[2] = 0x66;
421 1.1 jakllsch nxt2k_writereg(nxt, 0x82, buf, 3);
422 1.1 jakllsch
423 1.1 jakllsch nxt2k_readreg(nxt, 0x88, buf, 1);
424 1.1 jakllsch buf[0] = 0x11;
425 1.1 jakllsch nxt2k_writereg(nxt, 0x88, buf, 1);
426 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
427 1.1 jakllsch buf[0] = 0x40;
428 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
429 1.1 jakllsch
430 1.1 jakllsch nxt2k_readdata(nxt, 0x10, buf, 1);
431 1.1 jakllsch buf[0] = 0x10;
432 1.1 jakllsch nxt2k_writedata(nxt, 0x10, buf, 1);
433 1.1 jakllsch nxt2k_readdata(nxt, 0x0a, buf, 1);
434 1.1 jakllsch buf[0] = 0x21;
435 1.1 jakllsch nxt2k_writedata(nxt, 0x0a, buf, 1);
436 1.1 jakllsch
437 1.1 jakllsch nxt2k4_mc_init(nxt);
438 1.1 jakllsch
439 1.1 jakllsch buf[0] = 0x21;
440 1.1 jakllsch nxt2k_writedata(nxt, 0x0a, buf, 1);
441 1.1 jakllsch buf[0] = 0x7e;
442 1.1 jakllsch nxt2k_writedata(nxt, 0xe9, buf, 1);
443 1.1 jakllsch buf[0] = 0x00;
444 1.1 jakllsch nxt2k_writedata(nxt, 0xea, buf, 1);
445 1.1 jakllsch
446 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
447 1.1 jakllsch buf[0] = 0x00;
448 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
449 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
450 1.1 jakllsch buf[0] = 0x00;
451 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
452 1.1 jakllsch
453 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
454 1.1 jakllsch buf[0] = 0x10;
455 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
456 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
457 1.1 jakllsch buf[0] = 0x00;
458 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
459 1.1 jakllsch
460 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
461 1.1 jakllsch buf[0] = 0x04;
462 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
463 1.1 jakllsch buf[0] = 0x00;
464 1.1 jakllsch nxt2k_writereg(nxt, 0x81, buf, 1);
465 1.1 jakllsch buf[0] = 0x80; buf[1] = 0x00; buf[2] = 0x00;
466 1.1 jakllsch nxt2k_writereg(nxt, 0x82, buf, 3);
467 1.1 jakllsch
468 1.1 jakllsch nxt2k_readreg(nxt, 0x88, buf, 1);
469 1.1 jakllsch buf[0] = 0x11;
470 1.1 jakllsch nxt2k_writereg(nxt, 0x88, buf, 1);
471 1.1 jakllsch
472 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
473 1.1 jakllsch buf[0] = 0x44;
474 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
475 1.1 jakllsch
476 1.1 jakllsch /* init tuner */
477 1.1 jakllsch nxt2k_readdata(nxt, 0x10, buf, 1);
478 1.1 jakllsch buf[0] = 0x12;
479 1.1 jakllsch nxt2k_writedata(nxt, 0x10, buf,1);
480 1.1 jakllsch buf[0] = 0x04;
481 1.1 jakllsch nxt2k_writedata(nxt, 0x13, buf,1);
482 1.1 jakllsch buf[0] = 0x00;
483 1.1 jakllsch nxt2k_writedata(nxt, 0x16, buf,1);
484 1.1 jakllsch buf[0] = 0x04;
485 1.1 jakllsch nxt2k_writedata(nxt, 0x14, buf,1);
486 1.1 jakllsch buf[0] = 0x00;
487 1.1 jakllsch nxt2k_writedata(nxt, 0x14, buf,1);
488 1.1 jakllsch nxt2k_writedata(nxt, 0x17, buf,1);
489 1.1 jakllsch nxt2k_writedata(nxt, 0x14, buf,1);
490 1.1 jakllsch nxt2k_writedata(nxt, 0x17, buf,1);
491 1.1 jakllsch
492 1.1 jakllsch success = 1;
493 1.1 jakllsch return success;
494 1.1 jakllsch }
495 1.1 jakllsch
496 1.1 jakllsch uint16_t
497 1.1 jakllsch nxt2k_get_signal(struct nxt2k *nxt)
498 1.1 jakllsch {
499 1.1 jakllsch uint16_t temp;
500 1.1 jakllsch uint8_t b[2];
501 1.1 jakllsch
502 1.1 jakllsch b[0] = 0x00;
503 1.1 jakllsch nxt2k_writedata(nxt, 0xa1, b, 1);
504 1.1 jakllsch
505 1.1 jakllsch nxt2k_readreg(nxt, 0xa6, b, 2);
506 1.1 jakllsch
507 1.1 jakllsch temp = (b[0] << 8) | b[1];
508 1.1 jakllsch
509 1.1 jakllsch printf("a6: %04hx\n", temp);
510 1.1 jakllsch
511 1.1 jakllsch return 0x7fff - temp * 16;
512 1.1 jakllsch }
513 1.1 jakllsch
514 1.1 jakllsch uint16_t
515 1.1 jakllsch nxt2k_get_snr(struct nxt2k *nxt)
516 1.1 jakllsch {
517 1.1 jakllsch uint32_t tsnr;
518 1.1 jakllsch uint16_t temp, temp2;
519 1.1 jakllsch uint8_t b[2];
520 1.1 jakllsch
521 1.1 jakllsch b[0] = 0x00;
522 1.1 jakllsch nxt2k_writedata(nxt, 0xa1, b, 1);
523 1.1 jakllsch
524 1.1 jakllsch nxt2k_readreg(nxt, 0xa6, b, 2);
525 1.1 jakllsch
526 1.1 jakllsch temp = (b[0] << 8) | b[1];
527 1.1 jakllsch
528 1.1 jakllsch temp2 = 0x7fff - temp;
529 1.1 jakllsch
530 1.1 jakllsch printf("snr temp2: %04hx\n", temp2);
531 1.1 jakllsch
532 1.1 jakllsch if (temp2 > 0x7f00)
533 1.1 jakllsch tsnr = 1000*24+(1000*(30-24)*(temp2-0x7f00)/(0x7fff-0x7f00));
534 1.1 jakllsch else if ( temp2 > 0x7ec0)
535 1.1 jakllsch tsnr = 1000*18+(1000*(24-18)*(temp2-0x7ec0)/(0x7f00-0x7ec0));
536 1.1 jakllsch else if ( temp2 > 0x7c00)
537 1.1 jakllsch tsnr = 1000*12+(1000*(18-12)*(temp2-0x7c00)/(0x7ec0-0x7c00));
538 1.1 jakllsch else
539 1.1 jakllsch tsnr = 1000*0+(1000*(12-0)*(temp2-0)/(0x7c00-0));
540 1.1 jakllsch
541 1.1 jakllsch printf("snr tsnr: %08x\n", tsnr);
542 1.1 jakllsch
543 1.1 jakllsch return ((tsnr * 0xffff)/32000);
544 1.1 jakllsch }
545 1.1 jakllsch
546 1.1 jakllsch fe_status_t
547 1.1 jakllsch nxt2k_get_dtv_status(struct nxt2k *nxt)
548 1.1 jakllsch {
549 1.1 jakllsch uint8_t reg;
550 1.1 jakllsch fe_status_t status = 0;
551 1.1 jakllsch
552 1.1 jakllsch nxt2k_readdata(nxt, 0x31, ®, 1);
553 1.1 jakllsch if (reg & 0x20) {
554 1.1 jakllsch status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI |
555 1.1 jakllsch FE_HAS_SYNC | FE_HAS_LOCK;
556 1.1 jakllsch }
557 1.1 jakllsch
558 1.1 jakllsch return status;
559 1.1 jakllsch }
560 1.1 jakllsch
561 1.1 jakllsch #if notyet
562 1.1 jakllsch int
563 1.1 jakllsch nxt2k_fe_read_ucblocks(struct nxt2k *nxt, uint32_t *ucblk)
564 1.1 jakllsch {
565 1.1 jakllsch uint8_t reg[3];
566 1.1 jakllsch
567 1.1 jakllsch nxt2k_readreg(nxt, 0xe6, reg, 3);
568 1.1 jakllsch *ucblk = reg[2];
569 1.1 jakllsch
570 1.1 jakllsch return 0;
571 1.1 jakllsch }
572 1.1 jakllsch
573 1.1 jakllsch int
574 1.1 jakllsch nxt2k_fe_read_ber(struct nxt2k *nxt, uint32_t *ber)
575 1.1 jakllsch {
576 1.1 jakllsch uint8_t reg[3];
577 1.1 jakllsch
578 1.1 jakllsch nxt2k_readreg(nxt, 0xe6, reg, 3);
579 1.1 jakllsch
580 1.1 jakllsch *ber = ((reg[0] << 8) + reg[1]) * 8;
581 1.1 jakllsch
582 1.1 jakllsch return 0;
583 1.1 jakllsch }
584 1.1 jakllsch #endif
585 1.1 jakllsch
586 1.1 jakllsch static int
587 1.1 jakllsch nxt2k_fe_set_frontend(struct nxt2k *nxt, fe_modulation_t modulation)
588 1.1 jakllsch {
589 1.1 jakllsch uint8_t buf[5];
590 1.1 jakllsch
591 1.1 jakllsch if (nxt->loaded != true)
592 1.1 jakllsch nxt2k4_init(nxt);
593 1.1 jakllsch
594 1.1 jakllsch nxt2k_mc_stop(nxt);
595 1.1 jakllsch
596 1.1 jakllsch { /* 2k4 */
597 1.1 jakllsch /* make sure demod is set to digital */
598 1.1 jakllsch buf[0] = 0x04;
599 1.1 jakllsch nxt2k_writedata(nxt, 0x14, buf, 1);
600 1.1 jakllsch buf[0] = 0x00;
601 1.1 jakllsch nxt2k_writedata(nxt, 0x17, buf, 1);
602 1.1 jakllsch }
603 1.1 jakllsch
604 1.1 jakllsch /* QAM/VSB punctured/non-punctured goes here */
605 1.1 jakllsch
606 1.1 jakllsch /* tune in */
607 1.1 jakllsch /* maybe ensure tuner managed to tune in? */
608 1.1 jakllsch
609 1.1 jakllsch /* tuning done, reset agc */
610 1.1 jakllsch nxt2k_agc_reset(nxt);
611 1.1 jakllsch
612 1.1 jakllsch /* set target power level */
613 1.1 jakllsch switch (modulation) {
614 1.1 jakllsch case VSB_8:
615 1.1 jakllsch buf[0] = 0x70;
616 1.1 jakllsch break;
617 1.1 jakllsch case QAM_256:
618 1.1 jakllsch case QAM_64:
619 1.1 jakllsch buf[0] = 0x74;
620 1.1 jakllsch break;
621 1.1 jakllsch default:
622 1.1 jakllsch return EINVAL;
623 1.1 jakllsch /* NOTREACHED */
624 1.1 jakllsch }
625 1.1 jakllsch nxt2k_writedata(nxt, 0x42, buf, 1);
626 1.1 jakllsch
627 1.1 jakllsch /* configure sdm */
628 1.1 jakllsch buf[0] = 0x07; /* 2k4 */
629 1.1 jakllsch nxt2k_writedata(nxt, 0x57, buf, 1);
630 1.1 jakllsch
631 1.1 jakllsch /* write sdm1 input */
632 1.1 jakllsch buf[0] = 0x10;
633 1.1 jakllsch buf[1] = 0x00;
634 1.1 jakllsch nxt2k_writedata(nxt, 0x58, buf, 2); /* 2k4 */
635 1.1 jakllsch
636 1.1 jakllsch /* write sdmx input */
637 1.1 jakllsch switch (modulation) {
638 1.1 jakllsch case VSB_8:
639 1.1 jakllsch buf[0] = 0x60;
640 1.1 jakllsch break;
641 1.1 jakllsch case QAM_256:
642 1.1 jakllsch buf[0] = 0x64;
643 1.1 jakllsch break;
644 1.1 jakllsch case QAM_64:
645 1.1 jakllsch buf[0] = 0x68;
646 1.1 jakllsch break;
647 1.1 jakllsch default:
648 1.1 jakllsch return EINVAL;
649 1.1 jakllsch /* NOTREACHED */
650 1.1 jakllsch }
651 1.1 jakllsch buf[1] = 0x00;
652 1.1 jakllsch nxt2k_writedata(nxt, 0x5c, buf, 2); /* 2k4 */
653 1.1 jakllsch
654 1.1 jakllsch /* write adc power lpf fc */
655 1.1 jakllsch buf[0] = 0x05;
656 1.1 jakllsch nxt2k_writedata(nxt, 0x43, buf, 1);
657 1.1 jakllsch
658 1.1 jakllsch { /* 2k4 */
659 1.1 jakllsch buf[0] = 0x00;
660 1.1 jakllsch buf[1] = 0x00;
661 1.1 jakllsch nxt2k_writedata(nxt, 0x46, buf, 2);
662 1.1 jakllsch }
663 1.1 jakllsch
664 1.1 jakllsch /* write accumulator2 input */
665 1.1 jakllsch buf[0] = 0x80;
666 1.1 jakllsch buf[1] = 0x00;
667 1.1 jakllsch nxt2k_writedata(nxt, 0x4b, buf, 2); /* 2k4 */
668 1.1 jakllsch
669 1.1 jakllsch /* write kg1 */
670 1.1 jakllsch buf[0] = 0x00;
671 1.1 jakllsch nxt2k_writedata(nxt, 0x4d, buf, 1);
672 1.1 jakllsch
673 1.1 jakllsch /* write sdm12 lpf fc */
674 1.1 jakllsch buf[0] = 0x44;
675 1.1 jakllsch nxt2k_writedata(nxt, 0x55, buf, 1);
676 1.1 jakllsch
677 1.1 jakllsch /* write agc control reg */
678 1.1 jakllsch buf[0] = 0x04;
679 1.1 jakllsch nxt2k_writedata(nxt, 0x41, buf, 1);
680 1.1 jakllsch
681 1.1 jakllsch { /* 2k4 */
682 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
683 1.1 jakllsch buf[0] = 0x24;
684 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
685 1.1 jakllsch
686 1.1 jakllsch /* soft reset? */
687 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
688 1.1 jakllsch buf[0] = 0x10;
689 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
690 1.1 jakllsch nxt2k_readreg(nxt, 0x08, buf, 1);
691 1.1 jakllsch buf[0] = 0x00;
692 1.1 jakllsch nxt2k_writereg(nxt, 0x08, buf, 1);
693 1.1 jakllsch
694 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
695 1.1 jakllsch buf[0] = 0x04;
696 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
697 1.1 jakllsch
698 1.1 jakllsch buf[0] = 0x00;
699 1.1 jakllsch nxt2k_writereg(nxt, 0x81, buf, 1);
700 1.1 jakllsch
701 1.1 jakllsch buf[0] = 0x80; buf[1] = 0x00; buf[2] = 0x00;
702 1.1 jakllsch nxt2k_writereg(nxt, 0x82, buf, 3);
703 1.1 jakllsch
704 1.1 jakllsch nxt2k_readreg(nxt, 0x88, buf, 1);
705 1.1 jakllsch buf[0] = 0x11;
706 1.1 jakllsch nxt2k_writereg(nxt, 0x88, buf, 1);
707 1.1 jakllsch
708 1.1 jakllsch nxt2k_readreg(nxt, 0x80, buf, 1);
709 1.1 jakllsch buf[0] = 0x44;
710 1.1 jakllsch nxt2k_writereg(nxt, 0x80, buf, 1);
711 1.1 jakllsch }
712 1.1 jakllsch
713 1.1 jakllsch /* write agc ucgp0 */
714 1.1 jakllsch switch (modulation) {
715 1.1 jakllsch case VSB_8:
716 1.1 jakllsch buf[0] = 0x00;
717 1.1 jakllsch break;
718 1.1 jakllsch case QAM_64:
719 1.1 jakllsch buf[0] = 0x02;
720 1.1 jakllsch break;
721 1.1 jakllsch case QAM_256:
722 1.1 jakllsch buf[0] = 0x03;
723 1.1 jakllsch break;
724 1.1 jakllsch default:
725 1.1 jakllsch return EINVAL;
726 1.1 jakllsch /* NOTREACHED */
727 1.1 jakllsch }
728 1.1 jakllsch nxt2k_writedata(nxt, 0x30, buf, 1);
729 1.1 jakllsch
730 1.1 jakllsch /* write agc control reg */
731 1.1 jakllsch buf[0] = 0x00;
732 1.1 jakllsch nxt2k_writedata(nxt, 0x41, buf, 1);
733 1.1 jakllsch
734 1.1 jakllsch /* write accumulator2 input */
735 1.1 jakllsch buf[0] = 0x80;
736 1.1 jakllsch buf[1] = 0x00;
737 1.1 jakllsch { /* 2k4 */
738 1.1 jakllsch nxt2k_writedata(nxt, 0x49, buf, 2);
739 1.1 jakllsch nxt2k_writedata(nxt, 0x4b, buf, 2);
740 1.1 jakllsch }
741 1.1 jakllsch
742 1.1 jakllsch /* write agc control reg */
743 1.1 jakllsch buf[0] = 0x04;
744 1.1 jakllsch nxt2k_writedata(nxt, 0x41, buf, 1);
745 1.1 jakllsch
746 1.1 jakllsch nxt2k_mc_start(nxt);
747 1.1 jakllsch
748 1.1 jakllsch { /* 2k4 */
749 1.1 jakllsch nxt2k4_mc_init(nxt);
750 1.1 jakllsch buf[0] = 0xf0;
751 1.1 jakllsch buf[1] = 0x00;
752 1.1 jakllsch nxt2k_writedata(nxt, 0x5c, buf, 2);
753 1.1 jakllsch }
754 1.1 jakllsch
755 1.1 jakllsch /* "adjacent channel detection" code would go here */
756 1.1 jakllsch
757 1.1 jakllsch return 0;
758 1.1 jakllsch }
759 1.1 jakllsch
760 1.1 jakllsch static int
761 1.1 jakllsch nxt2k_init(struct nxt2k *nxt)
762 1.1 jakllsch {
763 1.1 jakllsch int ret = 0;
764 1.1 jakllsch
765 1.1 jakllsch printf("%s\n", __func__);
766 1.1 jakllsch
767 1.1 jakllsch if (nxt->loaded != 1)
768 1.1 jakllsch ret = nxt2k4_init(nxt);
769 1.1 jakllsch
770 1.1 jakllsch return ret;
771 1.1 jakllsch }
772 1.1 jakllsch
773 1.1 jakllsch
774 1.1 jakllsch struct nxt2k *
775 1.1 jakllsch nxt2k_open(device_t parent, i2c_tag_t tag, i2c_addr_t addr, unsigned int if_freq)
776 1.1 jakllsch {
777 1.1 jakllsch struct nxt2k *nxt;
778 1.1 jakllsch int e;
779 1.1 jakllsch uint8_t b[5];
780 1.1 jakllsch
781 1.1 jakllsch nxt = kmem_alloc(sizeof(*nxt), KM_SLEEP);
782 1.1 jakllsch if (nxt == NULL)
783 1.1 jakllsch return NULL;
784 1.1 jakllsch
785 1.1 jakllsch nxt->parent = parent;
786 1.1 jakllsch nxt->tag = tag;
787 1.1 jakllsch nxt->addr = addr;
788 1.1 jakllsch
789 1.1 jakllsch /* read chip ids */
790 1.1 jakllsch e = nxt2k_readdata(nxt, 0x00, b, 5);
791 1.1 jakllsch
792 1.1 jakllsch if (e) {
793 1.1 jakllsch printf("%s read failed %d\n", __func__, e);
794 1.1 jakllsch kmem_free(nxt, sizeof(*nxt));
795 1.1 jakllsch return NULL;
796 1.1 jakllsch }
797 1.1 jakllsch
798 1.1 jakllsch if (b[0] != 0x05) {
799 1.1 jakllsch printf("%s unsupported %02x %02x %02x %02x %02x\n",
800 1.1 jakllsch __func__, b[0], b[1], b[2], b[3], b[4]);
801 1.1 jakllsch kmem_free(nxt, sizeof(*nxt));
802 1.1 jakllsch return NULL;
803 1.1 jakllsch }
804 1.1 jakllsch
805 1.1 jakllsch mutex_init(&nxt->mtx, MUTEX_DEFAULT, IPL_NONE);
806 1.1 jakllsch cv_init(&nxt->cv, "nxtpl");
807 1.1 jakllsch
808 1.1 jakllsch nxt->loaded = false;
809 1.1 jakllsch
810 1.1 jakllsch return nxt;
811 1.1 jakllsch }
812 1.1 jakllsch
813 1.1 jakllsch void
814 1.1 jakllsch nxt2k_close(struct nxt2k *nxt)
815 1.1 jakllsch {
816 1.1 jakllsch kmem_free(nxt, sizeof(*nxt));
817 1.1 jakllsch }
818 1.1 jakllsch
819 1.1 jakllsch void
820 1.1 jakllsch nxt2k_enable(struct nxt2k *nxt, bool enable)
821 1.1 jakllsch {
822 1.1 jakllsch if (enable == true)
823 1.1 jakllsch nxt2k_init(nxt);
824 1.1 jakllsch }
825 1.1 jakllsch
826 1.1 jakllsch int
827 1.1 jakllsch nxt2k_set_modulation(struct nxt2k *nxt, fe_modulation_t modulation)
828 1.1 jakllsch {
829 1.1 jakllsch return nxt2k_fe_set_frontend(nxt, modulation);
830 1.1 jakllsch }
831