coram.c revision 1.10 1 1.10 drochner /* $NetBSD: coram.c,v 1.10 2012/01/30 19:41:18 drochner 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.10 drochner __KERNEL_RCSID(0, "$NetBSD: coram.c,v 1.10 2012/01/30 19:41:18 drochner Exp $");
31 1.1 jakllsch
32 1.1 jakllsch #include <sys/param.h>
33 1.1 jakllsch #include <sys/systm.h>
34 1.1 jakllsch #include <sys/device.h>
35 1.1 jakllsch #include <sys/kmem.h>
36 1.1 jakllsch #include <sys/mutex.h>
37 1.2 jmcneill #include <sys/module.h>
38 1.1 jakllsch #include <sys/bus.h>
39 1.1 jakllsch
40 1.1 jakllsch #include <dev/dtv/dtvif.h>
41 1.1 jakllsch
42 1.1 jakllsch #include <dev/pci/cx23885reg.h>
43 1.1 jakllsch #include <dev/pci/coramvar.h>
44 1.1 jakllsch
45 1.1 jakllsch #include <dev/pci/pcivar.h>
46 1.1 jakllsch #include <dev/pci/pcireg.h>
47 1.1 jakllsch #include <dev/pci/pcidevs.h>
48 1.1 jakllsch #include <dev/i2c/i2cvar.h>
49 1.1 jakllsch #include <dev/i2c/at24cxxvar.h>
50 1.1 jakllsch
51 1.1 jakllsch #include <dev/i2c/cx24227var.h>
52 1.1 jakllsch #include <dev/i2c/mt2131var.h>
53 1.1 jakllsch
54 1.4 jmcneill /* #define CORAM_DEBUG */
55 1.5 jmcneill /* #define CORAM_ATTACH_I2C */
56 1.4 jmcneill
57 1.7 jmcneill static const struct coram_board coram_boards[] = {
58 1.6 jmcneill { PCI_VENDOR_HAUPPAUGE, 0x7911, "Hauppauge HVR-1250" },
59 1.6 jmcneill };
60 1.6 jmcneill
61 1.1 jakllsch static int coram_match(device_t, cfdata_t, void *);
62 1.1 jakllsch static void coram_attach(device_t, device_t, void *);
63 1.2 jmcneill static int coram_detach(device_t, int);
64 1.8 jmcneill static int coram_rescan(device_t, const char *, const int *);
65 1.2 jmcneill static void coram_childdet(device_t, device_t);
66 1.1 jakllsch static bool coram_resume(device_t, const pmf_qual_t *);
67 1.1 jakllsch static int coram_intr(void *);
68 1.6 jmcneill static const struct coram_board * coram_board_lookup(uint16_t, uint16_t);
69 1.1 jakllsch
70 1.1 jakllsch static int coram_iic_exec(void *, i2c_op_t, i2c_addr_t,
71 1.1 jakllsch const void *, size_t, void *, size_t, int);
72 1.1 jakllsch static int coram_iic_acquire_bus(void *, int);
73 1.1 jakllsch static void coram_iic_release_bus(void *, int);
74 1.1 jakllsch static int coram_iic_read(struct coram_iic_softc *, i2c_op_t, i2c_addr_t,
75 1.1 jakllsch const void *, size_t, void *, size_t, int);
76 1.1 jakllsch static int coram_iic_write(struct coram_iic_softc *, i2c_op_t, i2c_addr_t,
77 1.1 jakllsch const void *, size_t, void *, size_t, int);
78 1.1 jakllsch
79 1.1 jakllsch static void coram_dtv_get_devinfo(void *, struct dvb_frontend_info *);
80 1.1 jakllsch static int coram_dtv_open(void *, int);
81 1.1 jakllsch static void coram_dtv_close(void *);
82 1.1 jakllsch static int coram_dtv_set_tuner(void *, const struct dvb_frontend_parameters *);
83 1.1 jakllsch static fe_status_t coram_dtv_get_status(void *);
84 1.1 jakllsch static uint16_t coram_dtv_get_signal_strength(void *);
85 1.1 jakllsch static uint16_t coram_dtv_get_snr(void *);
86 1.8 jmcneill static int coram_dtv_start_transfer(void *, void (*)(void *, const struct dtv_payload *), void *);
87 1.1 jakllsch static int coram_dtv_stop_transfer(void *);
88 1.1 jakllsch
89 1.1 jakllsch static int coram_mpeg_attach(struct coram_softc *);
90 1.2 jmcneill static int coram_mpeg_detach(struct coram_softc *, int);
91 1.1 jakllsch static int coram_mpeg_reset(struct coram_softc *);
92 1.1 jakllsch static void * coram_mpeg_malloc(struct coram_softc *, size_t);
93 1.1 jakllsch static int coram_allocmem(struct coram_softc *, size_t, size_t, struct coram_dma *);
94 1.1 jakllsch static void coram_mpeg_free(struct coram_softc *, void *);
95 1.1 jakllsch static int coram_mpeg_halt(struct coram_softc *);
96 1.1 jakllsch static int coram_freemem(struct coram_softc *, struct coram_dma *);
97 1.1 jakllsch static int coram_mpeg_trigger(struct coram_softc *, void *);
98 1.1 jakllsch static int coram_risc_buffer(struct coram_softc *, uint32_t, uint32_t);
99 1.1 jakllsch static int coram_risc_field(struct coram_softc *, uint32_t *, uint32_t);
100 1.1 jakllsch static int coram_sram_ch_setup(struct coram_softc *, struct coram_sram_ch *, uint32_t);
101 1.1 jakllsch static int coram_mpeg_intr(struct coram_softc *);
102 1.1 jakllsch
103 1.2 jmcneill CFATTACH_DECL2_NEW(coram, sizeof(struct coram_softc),
104 1.8 jmcneill coram_match, coram_attach, coram_detach, NULL,
105 1.8 jmcneill coram_rescan, coram_childdet);
106 1.1 jakllsch
107 1.1 jakllsch #define CORAM_SRAM_CH6 0
108 1.1 jakllsch
109 1.1 jakllsch #define CORAM_TS_PKTSIZE (188 * 8)
110 1.1 jakllsch
111 1.1 jakllsch static struct coram_sram_ch coram_sram_chs[] = {
112 1.1 jakllsch [CORAM_SRAM_CH6] = {
113 1.1 jakllsch .csc_cmds= 0x10140,
114 1.1 jakllsch .csc_iq = 0x10500,
115 1.1 jakllsch .csc_iqsz = 0x40,
116 1.1 jakllsch .csc_cdt = 0x10600,
117 1.1 jakllsch .csc_cdtsz = 0x10,
118 1.1 jakllsch .csc_fifo = 0x6000,
119 1.1 jakllsch .csc_fifosz = 0x1000,
120 1.1 jakllsch .csc_risc = 0x10800,
121 1.1 jakllsch .csc_riscsz = 0x800,
122 1.1 jakllsch .csc_ptr1 = DMA5_PTR1,
123 1.1 jakllsch .csc_ptr2 = DMA5_PTR2,
124 1.1 jakllsch .csc_cnt1 = DMA5_CNT1,
125 1.1 jakllsch .csc_cnt2 = DMA5_CNT2,
126 1.1 jakllsch },
127 1.1 jakllsch };
128 1.1 jakllsch
129 1.1 jakllsch static const struct dtv_hw_if coram_dtv_if = {
130 1.1 jakllsch .get_devinfo = coram_dtv_get_devinfo,
131 1.1 jakllsch .open = coram_dtv_open,
132 1.1 jakllsch .close = coram_dtv_close,
133 1.1 jakllsch .set_tuner = coram_dtv_set_tuner,
134 1.1 jakllsch .get_status = coram_dtv_get_status,
135 1.1 jakllsch .get_signal_strength = coram_dtv_get_signal_strength,
136 1.1 jakllsch .get_snr = coram_dtv_get_snr,
137 1.1 jakllsch .start_transfer = coram_dtv_start_transfer,
138 1.1 jakllsch .stop_transfer = coram_dtv_stop_transfer,
139 1.1 jakllsch };
140 1.1 jakllsch
141 1.1 jakllsch static int
142 1.1 jakllsch coram_match(device_t parent, cfdata_t match, void *v)
143 1.1 jakllsch {
144 1.1 jakllsch const struct pci_attach_args *pa = v;
145 1.6 jmcneill pcireg_t subid;
146 1.1 jakllsch
147 1.1 jakllsch if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_CONEXANT)
148 1.1 jakllsch return 0;
149 1.6 jmcneill if (PCI_PRODUCT(pa->pa_id) != PCI_PRODUCT_CONEXANT_CX23885)
150 1.6 jmcneill return 0;
151 1.1 jakllsch
152 1.6 jmcneill subid = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
153 1.6 jmcneill if (coram_board_lookup(PCI_VENDOR(subid), PCI_PRODUCT(subid)) == NULL)
154 1.6 jmcneill return 0;
155 1.1 jakllsch
156 1.6 jmcneill return 1;
157 1.1 jakllsch }
158 1.1 jakllsch
159 1.1 jakllsch static void
160 1.1 jakllsch coram_attach(device_t parent, device_t self, void *v)
161 1.1 jakllsch {
162 1.6 jmcneill struct coram_softc *sc = device_private(self);
163 1.1 jakllsch const struct pci_attach_args *pa = v;
164 1.1 jakllsch pci_intr_handle_t ih;
165 1.1 jakllsch pcireg_t reg;
166 1.1 jakllsch const char *intrstr;
167 1.1 jakllsch struct coram_iic_softc *cic;
168 1.5 jmcneill uint32_t value;
169 1.5 jmcneill int i;
170 1.5 jmcneill #ifdef CORAM_ATTACH_I2C
171 1.1 jakllsch struct i2cbus_attach_args iba;
172 1.5 jmcneill #endif
173 1.1 jakllsch
174 1.1 jakllsch sc->sc_dev = self;
175 1.1 jakllsch
176 1.10 drochner pci_aprint_devinfo(pa, NULL);
177 1.1 jakllsch
178 1.1 jakllsch reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
179 1.6 jmcneill sc->sc_board = coram_board_lookup(PCI_VENDOR(reg), PCI_PRODUCT(reg));
180 1.6 jmcneill KASSERT(sc->sc_board != NULL);
181 1.1 jakllsch
182 1.1 jakllsch if (pci_mapreg_map(pa, CX23885_MMBASE, PCI_MAPREG_TYPE_MEM, 0,
183 1.1 jakllsch &sc->sc_memt, &sc->sc_memh, NULL, &sc->sc_mems)) {
184 1.1 jakllsch aprint_error_dev(self, "couldn't map memory space\n");
185 1.1 jakllsch return;
186 1.1 jakllsch }
187 1.1 jakllsch
188 1.1 jakllsch sc->sc_dmat = pa->pa_dmat;
189 1.2 jmcneill sc->sc_pc = pa->pa_pc;
190 1.1 jakllsch
191 1.1 jakllsch if (pci_intr_map(pa, &ih)) {
192 1.1 jakllsch aprint_error_dev(self, "couldn't map interrupt\n");
193 1.1 jakllsch return;
194 1.1 jakllsch }
195 1.1 jakllsch intrstr = pci_intr_string(pa->pa_pc, ih);
196 1.1 jakllsch sc->sc_ih = pci_intr_establish(pa->pa_pc, ih, IPL_VM,
197 1.1 jakllsch coram_intr, (void *)self);
198 1.1 jakllsch if (sc->sc_ih == NULL) {
199 1.1 jakllsch aprint_error_dev(self, "couldn't establish interrupt");
200 1.1 jakllsch if (intrstr != NULL)
201 1.1 jakllsch aprint_error(" at %s", intrstr);
202 1.1 jakllsch aprint_error("\n");
203 1.1 jakllsch return;
204 1.1 jakllsch }
205 1.1 jakllsch aprint_normal_dev(self, "interrupting at %s\n", intrstr);
206 1.1 jakllsch
207 1.1 jakllsch /* set master */
208 1.1 jakllsch reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
209 1.1 jakllsch reg |= PCI_COMMAND_MASTER_ENABLE;
210 1.1 jakllsch pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, reg);
211 1.1 jakllsch
212 1.1 jakllsch /* I2C */
213 1.1 jakllsch for(i = 0; i < I2C_NUM; i++) {
214 1.1 jakllsch cic = &sc->sc_iic[i];
215 1.1 jakllsch
216 1.1 jakllsch cic->cic_sc = sc;
217 1.1 jakllsch if(bus_space_subregion(sc->sc_memt, sc->sc_memh, I2C_BASE + (I2C_SIZE * i), I2C_SIZE, &cic->cic_regh))
218 1.1 jakllsch panic("failed to subregion i2c");
219 1.1 jakllsch
220 1.1 jakllsch mutex_init(&cic->cic_busmutex, MUTEX_DRIVER, IPL_NONE);
221 1.1 jakllsch cic->cic_i2c.ic_cookie = cic;
222 1.1 jakllsch cic->cic_i2c.ic_acquire_bus = coram_iic_acquire_bus;
223 1.1 jakllsch cic->cic_i2c.ic_release_bus = coram_iic_release_bus;
224 1.1 jakllsch cic->cic_i2c.ic_exec = coram_iic_exec;
225 1.1 jakllsch
226 1.5 jmcneill #ifdef CORAM_ATTACH_I2C
227 1.1 jakllsch /* attach iic(4) */
228 1.1 jakllsch memset(&iba, 0, sizeof(iba));
229 1.1 jakllsch iba.iba_tag = &cic->cic_i2c;
230 1.1 jakllsch iba.iba_type = I2C_TYPE_SMBUS;
231 1.2 jmcneill cic->cic_i2cdev = config_found_ia(self, "i2cbus",
232 1.2 jmcneill &iba, iicbus_print);
233 1.1 jakllsch #endif
234 1.1 jakllsch }
235 1.1 jakllsch
236 1.1 jakllsch /* HVR1250 GPIO */
237 1.1 jakllsch value = bus_space_read_4(sc->sc_memt, sc->sc_memh, 0x110010);
238 1.1 jakllsch #if 1
239 1.1 jakllsch value &= ~0x00010001;
240 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, 0x110010, value);
241 1.1 jakllsch delay(5000);
242 1.1 jakllsch #endif
243 1.1 jakllsch value |= 0x00010001;
244 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, 0x110010, value);
245 1.1 jakllsch
246 1.1 jakllsch #if 0
247 1.1 jakllsch int i;
248 1.1 jakllsch uint8_t foo[256];
249 1.1 jakllsch uint8_t bar;
250 1.1 jakllsch bar = 0;
251 1.1 jakllsch // seeprom_bootstrap_read(&sc->sc_i2c, 0x50, 0, 256, foo, 256);
252 1.1 jakllsch
253 1.1 jakllsch iic_acquire_bus(&sc->sc_i2c, I2C_F_POLL);
254 1.1 jakllsch iic_exec(&sc->sc_i2c, I2C_OP_READ_WITH_STOP, 0x50, &bar, 1, foo, 256, I2C_F_POLL);
255 1.1 jakllsch iic_release_bus(&sc->sc_i2c, I2C_F_POLL);
256 1.1 jakllsch
257 1.1 jakllsch printf("\n");
258 1.1 jakllsch for ( i = 0; i < 256; i++) {
259 1.1 jakllsch if ( (i % 8) == 0 )
260 1.1 jakllsch printf("%02x: ", i);
261 1.1 jakllsch
262 1.1 jakllsch printf("%02x", foo[i]);
263 1.1 jakllsch
264 1.1 jakllsch if ( (i % 8) == 7 )
265 1.1 jakllsch printf("\n");
266 1.1 jakllsch else
267 1.1 jakllsch printf(" ");
268 1.1 jakllsch }
269 1.1 jakllsch printf("\n");
270 1.1 jakllsch #endif
271 1.1 jakllsch
272 1.1 jakllsch sc->sc_demod = cx24227_open(sc->sc_dev, &sc->sc_iic[0].cic_i2c, 0x19);
273 1.2 jmcneill if (sc->sc_demod == NULL)
274 1.2 jmcneill aprint_error_dev(self, "couldn't open cx24227\n");
275 1.1 jakllsch sc->sc_tuner = mt2131_open(sc->sc_dev, &sc->sc_iic[0].cic_i2c, 0x61);
276 1.2 jmcneill if (sc->sc_tuner == NULL)
277 1.2 jmcneill aprint_error_dev(self, "couldn't open mt2131\n");
278 1.1 jakllsch
279 1.1 jakllsch coram_mpeg_attach(sc);
280 1.1 jakllsch
281 1.1 jakllsch if (!pmf_device_register(self, NULL, coram_resume))
282 1.1 jakllsch aprint_error_dev(self, "couldn't establish power handler\n");
283 1.1 jakllsch
284 1.1 jakllsch return;
285 1.1 jakllsch }
286 1.1 jakllsch
287 1.1 jakllsch static int
288 1.2 jmcneill coram_detach(device_t self, int flags)
289 1.2 jmcneill {
290 1.2 jmcneill struct coram_softc *sc = device_private(self);
291 1.2 jmcneill struct coram_iic_softc *cic;
292 1.2 jmcneill unsigned int i;
293 1.2 jmcneill int error;
294 1.2 jmcneill
295 1.2 jmcneill error = coram_mpeg_detach(sc, flags);
296 1.2 jmcneill if (error)
297 1.2 jmcneill return error;
298 1.2 jmcneill
299 1.2 jmcneill if (sc->sc_tuner)
300 1.2 jmcneill mt2131_close(sc->sc_tuner);
301 1.2 jmcneill if (sc->sc_demod)
302 1.2 jmcneill cx24227_close(sc->sc_demod);
303 1.2 jmcneill for (i = 0; i < I2C_NUM; i++) {
304 1.2 jmcneill cic = &sc->sc_iic[i];
305 1.2 jmcneill if (cic->cic_i2cdev)
306 1.2 jmcneill config_detach(cic->cic_i2cdev, flags);
307 1.2 jmcneill mutex_destroy(&cic->cic_busmutex);
308 1.2 jmcneill }
309 1.2 jmcneill pmf_device_deregister(self);
310 1.2 jmcneill
311 1.2 jmcneill if (sc->sc_mems)
312 1.2 jmcneill bus_space_unmap(sc->sc_memt, sc->sc_memh, sc->sc_mems);
313 1.2 jmcneill if (sc->sc_ih)
314 1.2 jmcneill pci_intr_disestablish(sc->sc_pc, sc->sc_ih);
315 1.2 jmcneill
316 1.2 jmcneill return 0;
317 1.2 jmcneill }
318 1.2 jmcneill
319 1.8 jmcneill static int
320 1.8 jmcneill coram_rescan(device_t self, const char *ifattr, const int *locs)
321 1.8 jmcneill {
322 1.8 jmcneill struct coram_softc *sc = device_private(self);
323 1.8 jmcneill struct dtv_attach_args daa;
324 1.8 jmcneill
325 1.8 jmcneill daa.hw = &coram_dtv_if;
326 1.8 jmcneill daa.priv = sc;
327 1.8 jmcneill
328 1.8 jmcneill if (ifattr_match(ifattr, "dtvbus") && sc->sc_dtvdev == NULL)
329 1.8 jmcneill sc->sc_dtvdev = config_found_ia(sc->sc_dev, "dtvbus",
330 1.8 jmcneill &daa, dtv_print);
331 1.8 jmcneill
332 1.8 jmcneill return 0;
333 1.8 jmcneill }
334 1.8 jmcneill
335 1.2 jmcneill static void
336 1.2 jmcneill coram_childdet(device_t self, device_t child)
337 1.2 jmcneill {
338 1.2 jmcneill struct coram_softc *sc = device_private(self);
339 1.2 jmcneill struct coram_iic_softc *cic;
340 1.2 jmcneill unsigned int i;
341 1.2 jmcneill
342 1.2 jmcneill if (sc->sc_dtvdev == child)
343 1.2 jmcneill sc->sc_dtvdev = NULL;
344 1.2 jmcneill
345 1.2 jmcneill for (i = 0; i < I2C_NUM; i++) {
346 1.2 jmcneill cic = &sc->sc_iic[i];
347 1.2 jmcneill if (cic->cic_i2cdev == child)
348 1.2 jmcneill cic->cic_i2cdev = NULL;
349 1.2 jmcneill }
350 1.2 jmcneill }
351 1.2 jmcneill
352 1.2 jmcneill static int
353 1.1 jakllsch coram_intr(void *v)
354 1.1 jakllsch {
355 1.1 jakllsch device_t self = v;
356 1.1 jakllsch struct coram_softc *sc;
357 1.1 jakllsch uint32_t val;
358 1.1 jakllsch
359 1.1 jakllsch sc = device_private(self);
360 1.1 jakllsch
361 1.1 jakllsch val = bus_space_read_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSTAT );
362 1.1 jakllsch if (val == 0)
363 1.1 jakllsch return 0; /* not ours */
364 1.1 jakllsch
365 1.1 jakllsch /* vid c */
366 1.1 jakllsch if (val & __BIT(2))
367 1.1 jakllsch coram_mpeg_intr(sc);
368 1.1 jakllsch
369 1.1 jakllsch if (val & ~__BIT(2))
370 1.1 jakllsch printf("%s %08x\n", __func__, val);
371 1.1 jakllsch
372 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_STAT, val);
373 1.1 jakllsch
374 1.1 jakllsch return 1;
375 1.1 jakllsch }
376 1.1 jakllsch
377 1.6 jmcneill static const struct coram_board *
378 1.6 jmcneill coram_board_lookup(uint16_t vendor, uint16_t product)
379 1.6 jmcneill {
380 1.6 jmcneill unsigned int i;
381 1.6 jmcneill
382 1.6 jmcneill for (i = 0; i < __arraycount(coram_boards); i++) {
383 1.6 jmcneill if (coram_boards[i].vendor == vendor &&
384 1.6 jmcneill coram_boards[i].product == product) {
385 1.6 jmcneill return &coram_boards[i];
386 1.6 jmcneill }
387 1.6 jmcneill }
388 1.6 jmcneill
389 1.6 jmcneill return NULL;
390 1.6 jmcneill }
391 1.6 jmcneill
392 1.1 jakllsch #define CXDTV_TS_RISCI2 (1 << 4)
393 1.1 jakllsch #define CXDTV_TS_RISCI1 (1 << 0)
394 1.1 jakllsch
395 1.1 jakllsch #define CXDTV_TS_RISCI (CXDTV_TS_RISCI1|CXDTV_TS_RISCI2)
396 1.1 jakllsch
397 1.1 jakllsch static int
398 1.1 jakllsch coram_mpeg_intr(struct coram_softc *sc)
399 1.1 jakllsch {
400 1.1 jakllsch struct dtv_payload payload;
401 1.1 jakllsch uint32_t s, m, v;
402 1.1 jakllsch int i;
403 1.1 jakllsch
404 1.1 jakllsch s = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_INT_STAT);
405 1.1 jakllsch m = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK);
406 1.1 jakllsch
407 1.1 jakllsch if ((s & m) == 0)
408 1.1 jakllsch return 0;
409 1.1 jakllsch
410 1.1 jakllsch if ( (s & ~CXDTV_TS_RISCI) != 0 ) {
411 1.1 jakllsch printf("%s: unexpected TS IS %08x\n",
412 1.1 jakllsch device_xname(sc->sc_dev), s);
413 1.1 jakllsch
414 1.1 jakllsch printf("cmds:\n");
415 1.1 jakllsch for(i = 0; i < 20; i++)
416 1.1 jakllsch {
417 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, 0x10140 +(i*4));
418 1.1 jakllsch printf("%06x %08x\n", 0x10140+(i*4), v);
419 1.1 jakllsch }
420 1.1 jakllsch }
421 1.1 jakllsch
422 1.8 jmcneill if (sc->sc_dtvsubmitcb == NULL)
423 1.8 jmcneill goto done;
424 1.8 jmcneill
425 1.1 jakllsch if ((s & CXDTV_TS_RISCI1) == CXDTV_TS_RISCI1) {
426 1.1 jakllsch bus_dmamap_sync(sc->sc_dmat, sc->sc_dma->map,
427 1.1 jakllsch 0, CORAM_TS_PKTSIZE,
428 1.1 jakllsch BUS_DMASYNC_POSTREAD);
429 1.1 jakllsch payload.data = KERNADDR(sc->sc_dma);
430 1.1 jakllsch payload.size = CORAM_TS_PKTSIZE;
431 1.8 jmcneill sc->sc_dtvsubmitcb(sc->sc_dtvsubmitarg, &payload);
432 1.1 jakllsch }
433 1.1 jakllsch
434 1.1 jakllsch if ((s & CXDTV_TS_RISCI2) == CXDTV_TS_RISCI2) {
435 1.1 jakllsch bus_dmamap_sync(sc->sc_dmat, sc->sc_dma->map,
436 1.1 jakllsch CORAM_TS_PKTSIZE, CORAM_TS_PKTSIZE,
437 1.1 jakllsch BUS_DMASYNC_POSTREAD);
438 1.1 jakllsch payload.data = (char *)(KERNADDR(sc->sc_dma)) + (uintptr_t)CORAM_TS_PKTSIZE;
439 1.1 jakllsch payload.size = CORAM_TS_PKTSIZE;
440 1.8 jmcneill sc->sc_dtvsubmitcb(sc->sc_dtvsubmitarg, &payload);
441 1.1 jakllsch }
442 1.1 jakllsch
443 1.8 jmcneill done:
444 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_INT_STAT, s);
445 1.1 jakllsch
446 1.1 jakllsch return 1;
447 1.1 jakllsch }
448 1.1 jakllsch
449 1.1 jakllsch static bool
450 1.1 jakllsch coram_resume(device_t dv, const pmf_qual_t *qual)
451 1.1 jakllsch {
452 1.1 jakllsch struct coram_softc *sc;
453 1.1 jakllsch sc = device_private(dv);
454 1.1 jakllsch
455 1.1 jakllsch return true;
456 1.1 jakllsch }
457 1.1 jakllsch
458 1.1 jakllsch static int
459 1.1 jakllsch coram_iic_acquire_bus(void *cookie, int flags)
460 1.1 jakllsch {
461 1.1 jakllsch struct coram_iic_softc *cic;
462 1.1 jakllsch
463 1.1 jakllsch cic = cookie;
464 1.1 jakllsch
465 1.1 jakllsch if (flags & I2C_F_POLL) {
466 1.1 jakllsch while (mutex_tryenter(&cic->cic_busmutex) == 0)
467 1.1 jakllsch delay(50);
468 1.1 jakllsch return 0;
469 1.1 jakllsch }
470 1.1 jakllsch
471 1.1 jakllsch mutex_enter(&cic->cic_busmutex);
472 1.1 jakllsch
473 1.1 jakllsch return 0;
474 1.1 jakllsch }
475 1.1 jakllsch
476 1.1 jakllsch static void
477 1.1 jakllsch coram_iic_release_bus(void *cookie, int flags)
478 1.1 jakllsch {
479 1.1 jakllsch struct coram_iic_softc *cic;
480 1.1 jakllsch
481 1.1 jakllsch cic = cookie;
482 1.1 jakllsch
483 1.1 jakllsch mutex_exit(&cic->cic_busmutex);
484 1.1 jakllsch
485 1.1 jakllsch return;
486 1.1 jakllsch }
487 1.1 jakllsch
488 1.1 jakllsch /* I2C Bus */
489 1.1 jakllsch
490 1.1 jakllsch #define I2C_ADDR 0x0000
491 1.1 jakllsch #define I2C_WDATA 0x0004
492 1.1 jakllsch #define I2C_CTRL 0x0008
493 1.1 jakllsch #define I2C_RDATA 0x000c
494 1.1 jakllsch #define I2C_STAT 0x0010
495 1.1 jakllsch
496 1.1 jakllsch #define I2C_EXTEND (1 << 3)
497 1.1 jakllsch #define I2C_NOSTOP (1 << 4)
498 1.1 jakllsch
499 1.1 jakllsch static int
500 1.1 jakllsch coram_iic_exec(void *cookie, i2c_op_t op, i2c_addr_t addr,
501 1.1 jakllsch const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
502 1.1 jakllsch {
503 1.1 jakllsch struct coram_iic_softc *cic;
504 1.1 jakllsch int ret;
505 1.1 jakllsch
506 1.1 jakllsch cic = cookie;
507 1.1 jakllsch
508 1.1 jakllsch if(cmdlen) {
509 1.1 jakllsch ret = coram_iic_write(cic, op, addr, cmdbuf, cmdlen, buf, len, flags);
510 1.1 jakllsch if(ret)
511 1.1 jakllsch return ret;
512 1.1 jakllsch }
513 1.1 jakllsch
514 1.1 jakllsch if(len) {
515 1.1 jakllsch ret = coram_iic_read(cic, op, addr, cmdbuf, cmdlen, buf, len, flags);
516 1.1 jakllsch if(ret)
517 1.1 jakllsch return ret;
518 1.1 jakllsch }
519 1.1 jakllsch
520 1.1 jakllsch
521 1.1 jakllsch return 0;
522 1.1 jakllsch
523 1.1 jakllsch }
524 1.1 jakllsch
525 1.1 jakllsch static int
526 1.1 jakllsch coram_iic_read(struct coram_iic_softc *cic, i2c_op_t op, i2c_addr_t addr,
527 1.1 jakllsch const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
528 1.1 jakllsch {
529 1.1 jakllsch uint8_t *rb;
530 1.1 jakllsch uint32_t ctrl;
531 1.1 jakllsch int bn;
532 1.1 jakllsch
533 1.1 jakllsch rb = buf;
534 1.1 jakllsch
535 1.1 jakllsch for ( bn = 0; bn < len; bn++) {
536 1.1 jakllsch ctrl = (0x9d << 24) | (1 << 12) | (1 << 2) | 1;
537 1.1 jakllsch if ( bn < len - 1 )
538 1.1 jakllsch ctrl |= I2C_NOSTOP | I2C_EXTEND;
539 1.1 jakllsch
540 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_ADDR, addr<<25);
541 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_CTRL, ctrl);
542 1.1 jakllsch
543 1.1 jakllsch while((bus_space_read_4(cic->cic_sc->sc_memt, cic->cic_regh,
544 1.1 jakllsch I2C_STAT) & 0x02)) {
545 1.1 jakllsch delay(25);
546 1.1 jakllsch }
547 1.1 jakllsch if((bus_space_read_4(cic->cic_sc->sc_memt, cic->cic_regh,
548 1.1 jakllsch I2C_STAT) & 0x01) == 0x00) {
549 1.1 jakllsch // printf("%s %d no ack\n", __func__, bn);
550 1.1 jakllsch return EIO;
551 1.1 jakllsch }
552 1.1 jakllsch
553 1.1 jakllsch rb[bn] = bus_space_read_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_RDATA);
554 1.1 jakllsch
555 1.1 jakllsch }
556 1.1 jakllsch
557 1.1 jakllsch return 0;
558 1.1 jakllsch }
559 1.1 jakllsch
560 1.1 jakllsch static int
561 1.1 jakllsch coram_iic_write(struct coram_iic_softc *cic, i2c_op_t op, i2c_addr_t addr,
562 1.1 jakllsch const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
563 1.1 jakllsch {
564 1.1 jakllsch const uint8_t *wb;
565 1.1 jakllsch uint32_t wdata, addrreg, ctrl;
566 1.1 jakllsch int bn;
567 1.1 jakllsch
568 1.1 jakllsch wb = cmdbuf;
569 1.1 jakllsch
570 1.1 jakllsch addrreg = (addr << 25) | wb[0];
571 1.1 jakllsch wdata = wb[0];
572 1.1 jakllsch ctrl = (0x9d << 24) | (1 << 12) | (1 << 2);
573 1.1 jakllsch
574 1.1 jakllsch if ( cmdlen > 1 )
575 1.1 jakllsch ctrl |= I2C_NOSTOP | I2C_EXTEND;
576 1.1 jakllsch else if (len)
577 1.1 jakllsch ctrl |= I2C_NOSTOP;
578 1.1 jakllsch
579 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_ADDR, addrreg);
580 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_WDATA, wdata);
581 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_CTRL, ctrl);
582 1.1 jakllsch
583 1.1 jakllsch while((bus_space_read_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_STAT) & 0x02)) {
584 1.1 jakllsch delay(25); }
585 1.1 jakllsch
586 1.1 jakllsch for ( bn = 1; bn < cmdlen; bn++) {
587 1.1 jakllsch ctrl = (0x9d << 24) | (1 << 12) | (1 << 2);
588 1.1 jakllsch wdata = wb[bn];
589 1.1 jakllsch
590 1.1 jakllsch if ( bn < cmdlen - 1 )
591 1.1 jakllsch ctrl |= I2C_NOSTOP | I2C_EXTEND;
592 1.1 jakllsch else if (len)
593 1.1 jakllsch ctrl |= I2C_NOSTOP;
594 1.1 jakllsch
595 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_ADDR, addrreg);
596 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_WDATA, wdata);
597 1.1 jakllsch bus_space_write_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_CTRL, ctrl);
598 1.1 jakllsch
599 1.1 jakllsch while((bus_space_read_4(cic->cic_sc->sc_memt, cic->cic_regh, I2C_STAT) & 0x02)) {
600 1.1 jakllsch delay(25); }
601 1.1 jakllsch }
602 1.1 jakllsch
603 1.1 jakllsch return 0;
604 1.1 jakllsch }
605 1.1 jakllsch
606 1.1 jakllsch static int
607 1.1 jakllsch coram_mpeg_attach(struct coram_softc *sc)
608 1.1 jakllsch {
609 1.1 jakllsch struct coram_sram_ch *ch;
610 1.1 jakllsch
611 1.1 jakllsch ch = &coram_sram_chs[CORAM_SRAM_CH6];
612 1.1 jakllsch
613 1.1 jakllsch sc->sc_riscbufsz = ch->csc_riscsz;
614 1.1 jakllsch sc->sc_riscbuf = kmem_alloc(ch->csc_riscsz, KM_SLEEP);
615 1.1 jakllsch
616 1.1 jakllsch if ( sc->sc_riscbuf == NULL )
617 1.1 jakllsch panic("riscbuf null");
618 1.1 jakllsch
619 1.1 jakllsch coram_mpeg_reset(sc);
620 1.1 jakllsch
621 1.1 jakllsch sc->sc_tsbuf = NULL;
622 1.1 jakllsch
623 1.8 jmcneill coram_rescan(sc->sc_dev, NULL, NULL);
624 1.1 jakllsch
625 1.1 jakllsch return (sc->sc_dtvdev != NULL);
626 1.1 jakllsch }
627 1.1 jakllsch
628 1.2 jmcneill static int
629 1.2 jmcneill coram_mpeg_detach(struct coram_softc *sc, int flags)
630 1.2 jmcneill {
631 1.2 jmcneill struct coram_sram_ch *ch = &coram_sram_chs[CORAM_SRAM_CH6];
632 1.2 jmcneill int error;
633 1.2 jmcneill
634 1.2 jmcneill if (sc->sc_dtvdev) {
635 1.2 jmcneill error = config_detach(sc->sc_dtvdev, flags);
636 1.2 jmcneill if (error)
637 1.2 jmcneill return error;
638 1.2 jmcneill }
639 1.2 jmcneill if (sc->sc_riscbuf) {
640 1.2 jmcneill kmem_free(sc->sc_riscbuf, ch->csc_riscsz);
641 1.2 jmcneill }
642 1.2 jmcneill
643 1.2 jmcneill return 0;
644 1.2 jmcneill }
645 1.1 jakllsch
646 1.1 jakllsch static void
647 1.1 jakllsch coram_dtv_get_devinfo(void *cookie, struct dvb_frontend_info *info)
648 1.1 jakllsch {
649 1.6 jmcneill struct coram_softc *sc = cookie;
650 1.6 jmcneill
651 1.1 jakllsch memset(info, 0, sizeof(*info));
652 1.6 jmcneill strlcpy(info->name, sc->sc_board->name, sizeof(info->name));
653 1.1 jakllsch info->type = FE_ATSC;
654 1.1 jakllsch info->frequency_min = 54000000;
655 1.1 jakllsch info->frequency_max = 858000000;
656 1.1 jakllsch info->frequency_stepsize = 62500;
657 1.1 jakllsch info->caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB;
658 1.1 jakllsch }
659 1.1 jakllsch
660 1.1 jakllsch static int
661 1.1 jakllsch coram_dtv_open(void *cookie, int flags)
662 1.1 jakllsch {
663 1.1 jakllsch struct coram_softc *sc = cookie;
664 1.1 jakllsch
665 1.4 jmcneill #ifdef CORAM_DEBUG
666 1.1 jakllsch device_printf(sc->sc_dev, "%s\n", __func__);
667 1.4 jmcneill #endif
668 1.1 jakllsch
669 1.1 jakllsch //KASSERT(sc->sc_tsbuf == NULL);
670 1.1 jakllsch
671 1.2 jmcneill if (sc->sc_tuner == NULL || sc->sc_demod == NULL)
672 1.2 jmcneill return ENXIO;
673 1.2 jmcneill
674 1.1 jakllsch coram_mpeg_reset(sc);
675 1.1 jakllsch
676 1.1 jakllsch /* allocate two alternating DMA areas for MPEG TS packets */
677 1.1 jakllsch sc->sc_tsbuf = coram_mpeg_malloc(sc, CORAM_TS_PKTSIZE * 2);
678 1.1 jakllsch
679 1.1 jakllsch if (sc->sc_tsbuf == NULL)
680 1.1 jakllsch return ENOMEM;
681 1.1 jakllsch
682 1.1 jakllsch return 0;
683 1.1 jakllsch }
684 1.1 jakllsch
685 1.1 jakllsch static void
686 1.1 jakllsch coram_dtv_close(void *cookie)
687 1.1 jakllsch {
688 1.1 jakllsch struct coram_softc *sc = cookie;
689 1.1 jakllsch
690 1.4 jmcneill #ifdef CORAM_DEBUG
691 1.1 jakllsch device_printf(sc->sc_dev, "%s\n", __func__);
692 1.4 jmcneill #endif
693 1.1 jakllsch
694 1.1 jakllsch coram_mpeg_halt(sc);
695 1.1 jakllsch
696 1.1 jakllsch if (sc->sc_tsbuf != NULL) {
697 1.1 jakllsch coram_mpeg_free(sc, sc->sc_tsbuf);
698 1.1 jakllsch sc->sc_tsbuf = NULL;
699 1.1 jakllsch }
700 1.1 jakllsch }
701 1.1 jakllsch
702 1.1 jakllsch static int
703 1.1 jakllsch coram_dtv_set_tuner(void *cookie, const struct dvb_frontend_parameters *params)
704 1.1 jakllsch {
705 1.1 jakllsch struct coram_softc *sc = cookie;
706 1.1 jakllsch
707 1.1 jakllsch KASSERT(sc->sc_tuner != NULL);
708 1.1 jakllsch mt2131_tune_dtv(sc->sc_tuner, params);
709 1.1 jakllsch KASSERT(sc->sc_demod != NULL);
710 1.3 jmcneill return cx24227_set_modulation(sc->sc_demod, params->u.vsb.modulation);
711 1.1 jakllsch }
712 1.1 jakllsch
713 1.1 jakllsch static fe_status_t
714 1.1 jakllsch coram_dtv_get_status(void *cookie)
715 1.1 jakllsch {
716 1.3 jmcneill struct coram_softc *sc = cookie;
717 1.3 jmcneill
718 1.3 jmcneill if (sc->sc_demod == NULL)
719 1.3 jmcneill return ENXIO;
720 1.3 jmcneill
721 1.3 jmcneill return cx24227_get_dtv_status(sc->sc_demod);;
722 1.1 jakllsch }
723 1.1 jakllsch
724 1.1 jakllsch static uint16_t
725 1.1 jakllsch coram_dtv_get_signal_strength(void *cookie)
726 1.1 jakllsch {
727 1.1 jakllsch return 0;
728 1.1 jakllsch }
729 1.1 jakllsch
730 1.1 jakllsch static uint16_t
731 1.1 jakllsch coram_dtv_get_snr(void *cookie)
732 1.1 jakllsch {
733 1.1 jakllsch return 0;
734 1.1 jakllsch }
735 1.1 jakllsch
736 1.1 jakllsch static int
737 1.8 jmcneill coram_dtv_start_transfer(void *cookie,
738 1.8 jmcneill void (*cb)(void *, const struct dtv_payload *), void *arg)
739 1.1 jakllsch {
740 1.1 jakllsch struct coram_softc *sc = cookie;
741 1.1 jakllsch
742 1.4 jmcneill #ifdef CORAM_DEBUG
743 1.1 jakllsch device_printf(sc->sc_dev, "%s\n", __func__);
744 1.4 jmcneill #endif
745 1.1 jakllsch
746 1.8 jmcneill sc->sc_dtvsubmitcb = cb;
747 1.8 jmcneill sc->sc_dtvsubmitarg = arg;
748 1.8 jmcneill
749 1.1 jakllsch coram_mpeg_trigger(sc, sc->sc_tsbuf);
750 1.1 jakllsch
751 1.1 jakllsch return 0;
752 1.1 jakllsch }
753 1.1 jakllsch
754 1.1 jakllsch static int
755 1.1 jakllsch coram_dtv_stop_transfer(void *cookie)
756 1.1 jakllsch {
757 1.1 jakllsch struct coram_softc *sc = cookie;
758 1.1 jakllsch
759 1.4 jmcneill #ifdef CORAM_DEBUG
760 1.1 jakllsch device_printf(sc->sc_dev, "%s\n", __func__);
761 1.4 jmcneill #endif
762 1.1 jakllsch
763 1.1 jakllsch coram_mpeg_halt(sc);
764 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK, 0);
765 1.1 jakllsch
766 1.8 jmcneill sc->sc_dtvsubmitcb = NULL;
767 1.8 jmcneill sc->sc_dtvsubmitarg = NULL;
768 1.8 jmcneill
769 1.1 jakllsch return 0;
770 1.1 jakllsch }
771 1.1 jakllsch
772 1.1 jakllsch
773 1.1 jakllsch static int
774 1.1 jakllsch coram_mpeg_reset(struct coram_softc *sc)
775 1.1 jakllsch {
776 1.1 jakllsch uint32_t v;
777 1.1 jakllsch
778 1.1 jakllsch v = (uint32_t)-1;
779 1.1 jakllsch
780 1.1 jakllsch /* hold RISC in reset */
781 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, DEV_CNTRL2, 0);
782 1.1 jakllsch
783 1.1 jakllsch /* disable fifo + risc */
784 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_DMA_CTL, 0);
785 1.1 jakllsch
786 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK, 0);
787 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK, 0);
788 1.1 jakllsch
789 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_STAT, 0);
790 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_INT_STAT, 0);
791 1.1 jakllsch
792 1.1 jakllsch memset(sc->sc_riscbuf, 0, sc->sc_riscbufsz);
793 1.1 jakllsch
794 1.1 jakllsch return 0;
795 1.1 jakllsch }
796 1.1 jakllsch
797 1.1 jakllsch static void *
798 1.1 jakllsch coram_mpeg_malloc(struct coram_softc *sc, size_t size)
799 1.1 jakllsch {
800 1.1 jakllsch struct coram_dma *p;
801 1.1 jakllsch int err;
802 1.1 jakllsch
803 1.1 jakllsch p = kmem_alloc(sizeof(struct coram_dma), KM_SLEEP);
804 1.1 jakllsch if ( p == NULL )
805 1.1 jakllsch return NULL;
806 1.1 jakllsch err = coram_allocmem(sc, size, 16, p);
807 1.1 jakllsch if (err) {
808 1.1 jakllsch kmem_free(p, sizeof(struct coram_dma));
809 1.1 jakllsch return NULL;
810 1.1 jakllsch }
811 1.1 jakllsch
812 1.1 jakllsch p->next = sc->sc_dma;
813 1.1 jakllsch sc->sc_dma = p;
814 1.1 jakllsch
815 1.1 jakllsch return KERNADDR(p);
816 1.1 jakllsch }
817 1.1 jakllsch
818 1.1 jakllsch static int
819 1.1 jakllsch coram_allocmem(struct coram_softc *sc, size_t size, size_t align,
820 1.1 jakllsch struct coram_dma *p)
821 1.1 jakllsch {
822 1.1 jakllsch int err;
823 1.1 jakllsch
824 1.1 jakllsch p->size = size;
825 1.1 jakllsch err = bus_dmamem_alloc(sc->sc_dmat, p->size, align, 0,
826 1.1 jakllsch p->segs, sizeof(p->segs) / sizeof(p->segs[0]),
827 1.1 jakllsch &p->nsegs, BUS_DMA_NOWAIT);
828 1.1 jakllsch if (err)
829 1.1 jakllsch return err;
830 1.1 jakllsch err = bus_dmamem_map(sc->sc_dmat, p->segs, p->nsegs, p->size,
831 1.1 jakllsch &p->addr, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
832 1.1 jakllsch if (err)
833 1.1 jakllsch goto free;
834 1.1 jakllsch err = bus_dmamap_create(sc->sc_dmat, p->size, 1, p->size, 0,
835 1.1 jakllsch BUS_DMA_NOWAIT, &p->map);
836 1.1 jakllsch if (err)
837 1.1 jakllsch goto unmap;
838 1.1 jakllsch err = bus_dmamap_load(sc->sc_dmat, p->map, p->addr, p->size, NULL,
839 1.1 jakllsch BUS_DMA_NOWAIT);
840 1.1 jakllsch if (err)
841 1.1 jakllsch goto destroy;
842 1.1 jakllsch
843 1.1 jakllsch return 0;
844 1.1 jakllsch destroy:
845 1.1 jakllsch bus_dmamap_destroy(sc->sc_dmat, p->map);
846 1.1 jakllsch unmap:
847 1.1 jakllsch bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
848 1.1 jakllsch free:
849 1.1 jakllsch bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
850 1.1 jakllsch
851 1.1 jakllsch return err;
852 1.1 jakllsch }
853 1.1 jakllsch
854 1.1 jakllsch static int
855 1.1 jakllsch coram_mpeg_halt(struct coram_softc *sc)
856 1.1 jakllsch {
857 1.1 jakllsch uint32_t v;
858 1.1 jakllsch
859 1.4 jmcneill #ifdef CORAM_DEBUG
860 1.1 jakllsch device_printf(sc->sc_dev, "%s\n", __func__);
861 1.4 jmcneill #endif
862 1.1 jakllsch
863 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_DMA_CTL, 0);
864 1.1 jakllsch
865 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK);
866 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK,
867 1.1 jakllsch v & __BIT(2));
868 1.1 jakllsch
869 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK);
870 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK,
871 1.1 jakllsch v & 0);
872 1.1 jakllsch
873 1.1 jakllsch return 0;
874 1.1 jakllsch }
875 1.1 jakllsch
876 1.1 jakllsch static void
877 1.1 jakllsch coram_mpeg_free(struct coram_softc *sc, void *addr)
878 1.1 jakllsch {
879 1.1 jakllsch struct coram_dma *p;
880 1.1 jakllsch struct coram_dma **pp;
881 1.1 jakllsch
882 1.1 jakllsch for (pp = &sc->sc_dma; (p = *pp) != NULL; pp = &p->next)
883 1.1 jakllsch if (KERNADDR(p) == addr) {
884 1.1 jakllsch coram_freemem(sc, p);
885 1.1 jakllsch *pp = p->next;
886 1.1 jakllsch kmem_free(p, sizeof(struct coram_dma));
887 1.1 jakllsch return;
888 1.1 jakllsch }
889 1.1 jakllsch
890 1.1 jakllsch printf("%s: %p is already free\n", device_xname(sc->sc_dev), addr);
891 1.1 jakllsch return;
892 1.1 jakllsch }
893 1.1 jakllsch
894 1.1 jakllsch static int
895 1.1 jakllsch coram_freemem(struct coram_softc *sc, struct coram_dma *p)
896 1.1 jakllsch {
897 1.1 jakllsch bus_dmamap_unload(sc->sc_dmat, p->map);
898 1.1 jakllsch bus_dmamap_destroy(sc->sc_dmat, p->map);
899 1.1 jakllsch bus_dmamem_unmap(sc->sc_dmat, p->addr, p->size);
900 1.1 jakllsch bus_dmamem_free(sc->sc_dmat, p->segs, p->nsegs);
901 1.1 jakllsch
902 1.1 jakllsch return 0;
903 1.1 jakllsch }
904 1.1 jakllsch
905 1.1 jakllsch static int
906 1.1 jakllsch coram_mpeg_trigger(struct coram_softc *sc, void *buf)
907 1.1 jakllsch {
908 1.1 jakllsch struct coram_dma *p;
909 1.1 jakllsch struct coram_sram_ch *ch;
910 1.1 jakllsch uint32_t v;
911 1.1 jakllsch
912 1.1 jakllsch ch = &coram_sram_chs[CORAM_SRAM_CH6];
913 1.1 jakllsch
914 1.1 jakllsch for (p = sc->sc_dma; p && KERNADDR(p) != buf; p = p->next)
915 1.1 jakllsch continue;
916 1.1 jakllsch if (p == NULL) {
917 1.1 jakllsch printf("%s: coram_mpeg_trigger: bad addr %p\n",
918 1.1 jakllsch device_xname(sc->sc_dev), buf);
919 1.1 jakllsch return ENOENT;
920 1.1 jakllsch }
921 1.1 jakllsch
922 1.1 jakllsch /* disable fifo + risc */
923 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_DMA_CTL, 0);
924 1.1 jakllsch
925 1.1 jakllsch coram_risc_buffer(sc, CORAM_TS_PKTSIZE, 1);
926 1.1 jakllsch coram_sram_ch_setup(sc, ch, CORAM_TS_PKTSIZE);
927 1.1 jakllsch
928 1.1 jakllsch /* let me hope this bit is the same as on the 2388[0-3] */
929 1.1 jakllsch /* software reset */
930 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_GEN_CTL, 0x0040);
931 1.1 jakllsch delay (100*1000);
932 1.1 jakllsch
933 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_LNGTH, CORAM_TS_PKTSIZE);
934 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_HW_SOP_CTL, 0x47 << 16 | 188 << 4);
935 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_TS_CLK_EN, 1);
936 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_VLD_MISC, 0);
937 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_GEN_CTL, 12);
938 1.1 jakllsch delay (100*1000);
939 1.1 jakllsch
940 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, PAD_CTRL);
941 1.1 jakllsch v &= ~0x4; /* Clear TS2_SOP_OE */
942 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PAD_CTRL, v);
943 1.1 jakllsch
944 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK);
945 1.1 jakllsch v |= 0x111111;
946 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_INT_MSK, v);
947 1.1 jakllsch
948 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_DMA_CTL);
949 1.1 jakllsch v |= 0x11; /* Enable RISC controller and FIFO */
950 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, VID_C_DMA_CTL, v);
951 1.1 jakllsch
952 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, DEV_CNTRL2);
953 1.1 jakllsch v |= __BIT(5); /* Enable RISC controller */
954 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, DEV_CNTRL2, v);
955 1.1 jakllsch
956 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK);
957 1.1 jakllsch v |= 0x001f00;
958 1.1 jakllsch v |= 0x04;
959 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh, PCI_INT_MSK, v);
960 1.1 jakllsch
961 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_GEN_CTL);
962 1.4 jmcneill #ifdef CORAM_DEBUG
963 1.1 jakllsch printf("%s, %06x %08x\n", __func__, VID_C_GEN_CTL, v);
964 1.4 jmcneill #endif
965 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_SOP_STATUS);
966 1.4 jmcneill #ifdef CORAM_DEBUG
967 1.1 jakllsch printf("%s, %06x %08x\n", __func__, VID_C_SOP_STATUS, v);
968 1.4 jmcneill #endif
969 1.1 jakllsch delay(100*1000);
970 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_GEN_CTL);
971 1.4 jmcneill #ifdef CORAM_DEBUG
972 1.1 jakllsch printf("%s, %06x %08x\n", __func__, VID_C_GEN_CTL, v);
973 1.4 jmcneill #endif
974 1.1 jakllsch v = bus_space_read_4(sc->sc_memt, sc->sc_memh, VID_C_SOP_STATUS);
975 1.4 jmcneill #ifdef CORAM_DEBUG
976 1.1 jakllsch printf("%s, %06x %08x\n", __func__, VID_C_SOP_STATUS, v);
977 1.4 jmcneill #endif
978 1.1 jakllsch
979 1.1 jakllsch return 0;
980 1.1 jakllsch }
981 1.1 jakllsch
982 1.1 jakllsch static int
983 1.1 jakllsch coram_risc_buffer(struct coram_softc *sc, uint32_t bpl, uint32_t lines)
984 1.1 jakllsch {
985 1.1 jakllsch uint32_t *rm;
986 1.1 jakllsch uint32_t size;
987 1.1 jakllsch
988 1.1 jakllsch size = 1 + (bpl * lines) / PAGE_SIZE + lines;
989 1.1 jakllsch size += 2;
990 1.1 jakllsch
991 1.1 jakllsch if (sc->sc_riscbuf == NULL) {
992 1.1 jakllsch return ENOMEM;
993 1.1 jakllsch }
994 1.1 jakllsch
995 1.1 jakllsch rm = (uint32_t *)sc->sc_riscbuf;
996 1.1 jakllsch coram_risc_field(sc, rm, bpl);
997 1.1 jakllsch
998 1.1 jakllsch return 0;
999 1.1 jakllsch }
1000 1.1 jakllsch
1001 1.1 jakllsch static int
1002 1.1 jakllsch coram_risc_field(struct coram_softc *sc, uint32_t *rm, uint32_t bpl)
1003 1.1 jakllsch {
1004 1.1 jakllsch struct coram_dma *p;
1005 1.1 jakllsch
1006 1.1 jakllsch for (p = sc->sc_dma; p && KERNADDR(p) != sc->sc_tsbuf; p = p->next)
1007 1.1 jakllsch continue;
1008 1.1 jakllsch if (p == NULL) {
1009 1.1 jakllsch printf("%s: coram_risc_field: bad addr %p\n",
1010 1.1 jakllsch device_xname(sc->sc_dev), sc->sc_tsbuf);
1011 1.1 jakllsch return ENOENT;
1012 1.1 jakllsch }
1013 1.1 jakllsch
1014 1.1 jakllsch memset(sc->sc_riscbuf, 0, sc->sc_riscbufsz);
1015 1.1 jakllsch
1016 1.1 jakllsch rm = sc->sc_riscbuf;
1017 1.1 jakllsch
1018 1.1 jakllsch /* htole32 will be done when program is copied to chip sram */
1019 1.1 jakllsch
1020 1.1 jakllsch /* XXX */
1021 1.1 jakllsch *(rm++) = (CX_RISC_SYNC|0);
1022 1.1 jakllsch
1023 1.1 jakllsch *(rm++) = (CX_RISC_WRITE|CX_RISC_SOL|CX_RISC_EOL|CX_RISC_IRQ1|bpl);
1024 1.1 jakllsch *(rm++) = (DMAADDR(p) + 0 * bpl);
1025 1.1 jakllsch *(rm++) = 0; /* high dword */
1026 1.1 jakllsch
1027 1.1 jakllsch *(rm++) = (CX_RISC_WRITE|CX_RISC_SOL|CX_RISC_EOL|CX_RISC_IRQ2|bpl);
1028 1.1 jakllsch *(rm++) = (DMAADDR(p) + 1 * bpl);
1029 1.1 jakllsch *(rm++) = 0;
1030 1.1 jakllsch
1031 1.1 jakllsch *(rm++) = (CX_RISC_JUMP|1);
1032 1.1 jakllsch *(rm++) = (coram_sram_chs[CORAM_SRAM_CH6].csc_risc + 4);
1033 1.1 jakllsch *(rm++) = 0;
1034 1.1 jakllsch
1035 1.1 jakllsch return 0;
1036 1.1 jakllsch }
1037 1.1 jakllsch
1038 1.1 jakllsch static int
1039 1.1 jakllsch coram_sram_ch_setup(struct coram_softc *sc, struct coram_sram_ch *csc,
1040 1.1 jakllsch uint32_t bpl)
1041 1.1 jakllsch {
1042 1.1 jakllsch unsigned int i, lines;
1043 1.1 jakllsch uint32_t cdt;
1044 1.1 jakllsch
1045 1.1 jakllsch /* XXX why round? */
1046 1.1 jakllsch bpl = (bpl + 7) & ~7;
1047 1.1 jakllsch cdt = csc->csc_cdt;
1048 1.1 jakllsch lines = csc->csc_fifosz / bpl;
1049 1.4 jmcneill #ifdef CORAM_DEBUG
1050 1.1 jakllsch printf("%s %d lines\n", __func__, lines);
1051 1.4 jmcneill #endif
1052 1.1 jakllsch
1053 1.1 jakllsch /* fill in CDT */
1054 1.1 jakllsch for (i = 0; i < lines; i++) {
1055 1.4 jmcneill #ifdef CORAM_DEBUG
1056 1.1 jakllsch printf("CDT ent %08x, %08x\n", cdt + (16 * i),
1057 1.1 jakllsch csc->csc_fifo + (bpl * i));
1058 1.1 jakllsch #endif
1059 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1060 1.1 jakllsch cdt + (16 * i), csc->csc_fifo + (bpl * i));
1061 1.1 jakllsch }
1062 1.1 jakllsch
1063 1.1 jakllsch /* copy program */
1064 1.1 jakllsch /* converts program to little endian as it goes into sram */
1065 1.1 jakllsch bus_space_write_region_4(sc->sc_memt, sc->sc_memh,
1066 1.1 jakllsch csc->csc_risc, (void *)sc->sc_riscbuf, sc->sc_riscbufsz >> 2);
1067 1.1 jakllsch
1068 1.1 jakllsch /* fill in CMDS */
1069 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1070 1.1 jakllsch csc->csc_cmds + CMDS_O_IRPC, csc->csc_risc);
1071 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1072 1.1 jakllsch csc->csc_cmds + CMDS_O_IRPC + 4, 0);
1073 1.1 jakllsch
1074 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1075 1.1 jakllsch csc->csc_cmds + CMDS_O_CDTB, csc->csc_cdt);
1076 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1077 1.1 jakllsch csc->csc_cmds + CMDS_O_CDTS, (lines * 16) >> 3); /* XXX magic */
1078 1.1 jakllsch
1079 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1080 1.1 jakllsch csc->csc_cmds + CMDS_O_IQB, csc->csc_iq);
1081 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1082 1.1 jakllsch csc->csc_cmds + CMDS_O_IQS,
1083 1.1 jakllsch CMDS_IQS_ISRP | (csc->csc_iqsz >> 2) );
1084 1.1 jakllsch
1085 1.1 jakllsch /* zero rest of CMDS */
1086 1.1 jakllsch bus_space_set_region_4(sc->sc_memt, sc->sc_memh, 0x18, 0, 20);
1087 1.1 jakllsch
1088 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1089 1.1 jakllsch csc->csc_ptr1, csc->csc_fifo);
1090 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1091 1.1 jakllsch csc->csc_ptr2, cdt);
1092 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1093 1.1 jakllsch csc->csc_cnt2, (lines * 16) >> 3);
1094 1.1 jakllsch bus_space_write_4(sc->sc_memt, sc->sc_memh,
1095 1.1 jakllsch csc->csc_cnt1, (bpl >> 3) - 1);
1096 1.1 jakllsch
1097 1.1 jakllsch return 0;
1098 1.1 jakllsch }
1099 1.2 jmcneill
1100 1.9 jmcneill MODULE(MODULE_CLASS_DRIVER, coram, "cx24227,mt2131,pci");
1101 1.2 jmcneill
1102 1.2 jmcneill #ifdef _MODULE
1103 1.2 jmcneill #include "ioconf.c"
1104 1.2 jmcneill #endif
1105 1.2 jmcneill
1106 1.2 jmcneill static int
1107 1.2 jmcneill coram_modcmd(modcmd_t cmd, void *v)
1108 1.2 jmcneill {
1109 1.2 jmcneill int error = 0;
1110 1.2 jmcneill
1111 1.2 jmcneill switch (cmd) {
1112 1.2 jmcneill case MODULE_CMD_INIT:
1113 1.2 jmcneill #ifdef _MODULE
1114 1.2 jmcneill error = config_init_component(cfdriver_ioconf_coram,
1115 1.2 jmcneill cfattach_ioconf_coram, cfdata_ioconf_coram);
1116 1.2 jmcneill #endif
1117 1.2 jmcneill return error;
1118 1.2 jmcneill case MODULE_CMD_FINI:
1119 1.2 jmcneill #ifdef _MODULE
1120 1.2 jmcneill error = config_fini_component(cfdriver_ioconf_coram,
1121 1.2 jmcneill cfattach_ioconf_coram, cfdata_ioconf_coram);
1122 1.2 jmcneill #endif
1123 1.2 jmcneill return error;
1124 1.2 jmcneill default:
1125 1.2 jmcneill return ENOTTY;
1126 1.2 jmcneill }
1127 1.2 jmcneill }
1128