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