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