Home | History | Annotate | Line # | Download | only in dtv
dtv_device.c revision 1.12.22.1
      1  1.12.22.1   thorpej /* $NetBSD: dtv_device.c,v 1.12.22.1 2021/08/01 22:42:22 thorpej Exp $ */
      2        1.1  jmcneill 
      3        1.1  jmcneill /*-
      4        1.1  jmcneill  * Copyright (c) 2011 Jared D. McNeill <jmcneill (at) invisible.ca>
      5        1.1  jmcneill  * All rights reserved.
      6        1.1  jmcneill  *
      7        1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8        1.1  jmcneill  * modification, are permitted provided that the following conditions
      9        1.1  jmcneill  * are met:
     10        1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11        1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12        1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13        1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14        1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15        1.1  jmcneill  * 3. All advertising materials mentioning features or use of this software
     16        1.1  jmcneill  *    must display the following acknowledgement:
     17        1.1  jmcneill  *        This product includes software developed by Jared D. McNeill.
     18        1.1  jmcneill  * 4. Neither the name of The NetBSD Foundation nor the names of its
     19        1.1  jmcneill  *    contributors may be used to endorse or promote products derived
     20        1.1  jmcneill  *    from this software without specific prior written permission.
     21        1.1  jmcneill  *
     22        1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     23        1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     24        1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     25        1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     26        1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     27        1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     28        1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     29        1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     30        1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     31        1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     32        1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     33        1.1  jmcneill  */
     34        1.1  jmcneill 
     35        1.1  jmcneill #include <sys/cdefs.h>
     36  1.12.22.1   thorpej __KERNEL_RCSID(0, "$NetBSD: dtv_device.c,v 1.12.22.1 2021/08/01 22:42:22 thorpej Exp $");
     37        1.1  jmcneill 
     38  1.12.22.1   thorpej #include <sys/param.h>
     39        1.1  jmcneill #include <sys/types.h>
     40  1.12.22.1   thorpej #include <sys/atomic.h>
     41        1.1  jmcneill #include <sys/conf.h>
     42        1.1  jmcneill #include <sys/device.h>
     43        1.1  jmcneill #include <sys/module.h>
     44        1.1  jmcneill #include <sys/poll.h>
     45        1.1  jmcneill #include <sys/select.h>
     46        1.1  jmcneill 
     47        1.1  jmcneill #include <dev/dtv/dtvvar.h>
     48        1.1  jmcneill 
     49       1.12  riastrad #include "ioconf.h"
     50       1.12  riastrad 
     51        1.1  jmcneill MODULE(MODULE_CLASS_DRIVER, dtv, NULL);
     52        1.1  jmcneill 
     53        1.1  jmcneill static dev_type_open(dtvopen);
     54        1.1  jmcneill static dev_type_close(dtvclose);
     55        1.1  jmcneill static dev_type_read(dtvread);
     56        1.1  jmcneill static dev_type_ioctl(dtvioctl);
     57        1.1  jmcneill static dev_type_poll(dtvpoll);
     58        1.1  jmcneill 
     59        1.1  jmcneill const struct cdevsw dtv_cdevsw = {
     60        1.1  jmcneill 	.d_open = dtvopen,
     61        1.1  jmcneill 	.d_close = dtvclose,
     62        1.1  jmcneill 	.d_read = dtvread,
     63        1.4  jmcneill 	.d_write = nowrite,
     64        1.1  jmcneill 	.d_ioctl = dtvioctl,
     65        1.4  jmcneill 	.d_stop = nostop,
     66        1.4  jmcneill 	.d_tty = notty,
     67        1.1  jmcneill 	.d_poll = dtvpoll,
     68        1.4  jmcneill 	.d_mmap = nommap,
     69        1.4  jmcneill 	.d_kqfilter = nokqfilter,
     70       1.10  dholland 	.d_discard = nodiscard,
     71        1.9  dholland 	.d_flag = D_OTHER | D_MPSAFE,
     72        1.1  jmcneill };
     73        1.1  jmcneill 
     74        1.1  jmcneill static int	dtv_match(device_t, cfdata_t, void *);
     75        1.1  jmcneill static void	dtv_attach(device_t, device_t, void *);
     76        1.1  jmcneill static int	dtv_detach(device_t, int);
     77        1.1  jmcneill 
     78        1.1  jmcneill CFATTACH_DECL_NEW(dtv,
     79        1.1  jmcneill     sizeof(struct dtv_softc),
     80        1.1  jmcneill     dtv_match,
     81        1.1  jmcneill     dtv_attach,
     82        1.1  jmcneill     dtv_detach,
     83        1.1  jmcneill     NULL
     84        1.1  jmcneill );
     85        1.1  jmcneill 
     86        1.1  jmcneill static int
     87        1.1  jmcneill dtv_match(device_t parent, cfdata_t cfdata, void *aa)
     88        1.1  jmcneill {
     89        1.1  jmcneill 	return 1;
     90        1.1  jmcneill }
     91        1.1  jmcneill 
     92        1.1  jmcneill static void
     93        1.1  jmcneill dtv_attach(device_t parent, device_t self, void *aa)
     94        1.1  jmcneill {
     95        1.1  jmcneill 	struct dtv_attach_args *daa = aa;
     96        1.1  jmcneill 	struct dtv_softc *sc = device_private(self);
     97        1.1  jmcneill 	struct dtv_stream *ds = &sc->sc_stream;
     98        1.1  jmcneill 	struct dvb_frontend_info info;
     99        1.1  jmcneill 
    100        1.1  jmcneill 	sc->sc_dev = self;
    101        1.1  jmcneill 	sc->sc_hw = daa->hw;
    102        1.1  jmcneill 	sc->sc_priv = daa->priv;
    103        1.5  jmcneill 	sc->sc_open = 0;
    104        1.5  jmcneill 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
    105        1.1  jmcneill 
    106        1.1  jmcneill 	ds->ds_nbufs = 0;
    107        1.1  jmcneill 	ds->ds_buf = NULL;
    108        1.1  jmcneill 	SIMPLEQ_INIT(&ds->ds_ingress);
    109        1.1  jmcneill 	SIMPLEQ_INIT(&ds->ds_egress);
    110       1.11  jmcneill 	mutex_init(&ds->ds_egress_lock, MUTEX_DEFAULT, IPL_SCHED);
    111       1.11  jmcneill 	mutex_init(&ds->ds_ingress_lock, MUTEX_DEFAULT, IPL_SCHED);
    112        1.1  jmcneill 	cv_init(&ds->ds_sample_cv, "dtv");
    113        1.1  jmcneill 	selinit(&ds->ds_sel);
    114        1.1  jmcneill 	dtv_scatter_buf_init(&ds->ds_data);
    115        1.2  jmcneill 	if (dtv_buffer_realloc(sc, DTV_DEFAULT_BUFSIZE) != 0) {
    116        1.2  jmcneill 		aprint_error(": no memory\n");
    117        1.2  jmcneill 		sc->sc_dying = true;
    118        1.2  jmcneill 		return;
    119        1.2  jmcneill 	}
    120        1.1  jmcneill 
    121       1.11  jmcneill 	mutex_init(&sc->sc_demux_lock, MUTEX_DEFAULT, IPL_SCHED);
    122        1.5  jmcneill 	TAILQ_INIT(&sc->sc_demux_list);
    123        1.7  jmcneill 	sc->sc_demux_runcnt = 0;
    124        1.5  jmcneill 
    125        1.1  jmcneill 	dtv_device_get_devinfo(sc, &info);
    126        1.1  jmcneill 
    127        1.1  jmcneill 	aprint_naive("\n");
    128        1.4  jmcneill 	aprint_normal(": %s", info.name);
    129        1.1  jmcneill 	switch (info.type) {
    130        1.1  jmcneill 	case FE_QPSK:
    131        1.1  jmcneill 		aprint_normal(" [QPSK]");
    132        1.1  jmcneill 		break;
    133        1.1  jmcneill 	case FE_QAM:
    134        1.1  jmcneill 		aprint_normal(" [QAM]");
    135        1.1  jmcneill 		break;
    136        1.1  jmcneill 	case FE_OFDM:
    137        1.1  jmcneill 		aprint_normal(" [OFDM]");
    138        1.1  jmcneill 		break;
    139        1.1  jmcneill 	case FE_ATSC:
    140        1.1  jmcneill 		aprint_normal(" [ATSC]");
    141        1.1  jmcneill 		break;
    142        1.1  jmcneill 	}
    143        1.1  jmcneill 	aprint_normal("\n");
    144        1.1  jmcneill }
    145        1.1  jmcneill 
    146        1.1  jmcneill static int
    147        1.1  jmcneill dtv_detach(device_t self, int flags)
    148        1.1  jmcneill {
    149        1.1  jmcneill 	struct dtv_softc *sc = device_private(self);
    150        1.1  jmcneill 	struct dtv_stream *ds = &sc->sc_stream;
    151        1.1  jmcneill 
    152        1.1  jmcneill 	cv_destroy(&ds->ds_sample_cv);
    153        1.4  jmcneill 	mutex_destroy(&ds->ds_ingress_lock);
    154        1.4  jmcneill 	mutex_destroy(&ds->ds_egress_lock);
    155        1.1  jmcneill 	seldestroy(&ds->ds_sel);
    156        1.2  jmcneill 	dtv_buffer_realloc(sc, 0);
    157        1.1  jmcneill 	dtv_scatter_buf_destroy(&ds->ds_data);
    158        1.1  jmcneill 
    159        1.5  jmcneill 	mutex_destroy(&sc->sc_demux_lock);
    160        1.6  jmcneill 	mutex_destroy(&sc->sc_lock);
    161        1.5  jmcneill 
    162        1.1  jmcneill 	return 0;
    163        1.1  jmcneill }
    164        1.1  jmcneill 
    165        1.3  jmcneill #ifdef _MODULE
    166        1.3  jmcneill #include "ioconf.c"
    167        1.3  jmcneill #endif
    168        1.3  jmcneill 
    169        1.1  jmcneill static int
    170        1.1  jmcneill dtv_modcmd(modcmd_t cmd, void *arg)
    171        1.1  jmcneill {
    172        1.3  jmcneill #ifdef _MODULE
    173        1.1  jmcneill 	int error, bmaj = -1, cmaj = -1;
    174        1.3  jmcneill #endif
    175        1.1  jmcneill 
    176        1.1  jmcneill 	switch (cmd) {
    177        1.1  jmcneill 	case MODULE_CMD_INIT:
    178        1.3  jmcneill #ifdef _MODULE
    179        1.1  jmcneill 		error = config_init_component(cfdriver_ioconf_dtv,
    180        1.1  jmcneill 		    cfattach_ioconf_dtv, cfdata_ioconf_dtv);
    181        1.1  jmcneill 		if (error)
    182        1.1  jmcneill 			return error;
    183        1.1  jmcneill 		error = devsw_attach("dtv", NULL, &bmaj, &dtv_cdevsw, &cmaj);
    184        1.1  jmcneill 		if (error)
    185        1.1  jmcneill 			config_fini_component(cfdriver_ioconf_dtv,
    186        1.1  jmcneill 			    cfattach_ioconf_dtv, cfdata_ioconf_dtv);
    187        1.1  jmcneill 		return error;
    188        1.3  jmcneill #else
    189        1.3  jmcneill 		return 0;
    190        1.3  jmcneill #endif
    191        1.1  jmcneill 	case MODULE_CMD_FINI:
    192        1.3  jmcneill #ifdef _MODULE
    193        1.1  jmcneill 		devsw_detach(NULL, &dtv_cdevsw);
    194        1.1  jmcneill 		return config_fini_component(cfdriver_ioconf_dtv,
    195        1.1  jmcneill 		    cfattach_ioconf_dtv, cfdata_ioconf_dtv);
    196        1.3  jmcneill #else
    197        1.3  jmcneill 		return 0;
    198        1.3  jmcneill #endif
    199        1.1  jmcneill 	default:
    200        1.1  jmcneill 		return ENOTTY;
    201        1.1  jmcneill 	}
    202        1.1  jmcneill }
    203        1.1  jmcneill 
    204        1.1  jmcneill static int
    205        1.1  jmcneill dtvopen(dev_t dev, int flags, int mode, lwp_t *l)
    206        1.1  jmcneill {
    207        1.1  jmcneill 	struct dtv_softc *sc;
    208        1.1  jmcneill 	struct dtv_ts *ts;
    209        1.1  jmcneill 	int error;
    210        1.1  jmcneill 
    211        1.1  jmcneill 	if ((sc = device_lookup_private(&dtv_cd, DTVUNIT(dev))) == NULL)
    212        1.1  jmcneill 		return ENXIO;
    213        1.1  jmcneill 	if (sc->sc_dying == true)
    214        1.1  jmcneill 		return ENODEV;
    215        1.1  jmcneill 	ts = &sc->sc_ts;
    216        1.1  jmcneill 
    217        1.5  jmcneill 	mutex_enter(&sc->sc_lock);
    218        1.5  jmcneill 	if (sc->sc_open == 0) {
    219        1.1  jmcneill 		error = dtv_device_open(sc, flags);
    220        1.5  jmcneill 		if (error)
    221        1.1  jmcneill 			return error;
    222        1.1  jmcneill 		sc->sc_bufsize = DTV_DEFAULT_BUFSIZE;
    223        1.1  jmcneill 		sc->sc_bufsize_chg = true;
    224        1.1  jmcneill 		memset(ts->ts_pidfilter, 0, sizeof(ts->ts_pidfilter));
    225        1.1  jmcneill 	}
    226        1.5  jmcneill 	++sc->sc_open;
    227        1.5  jmcneill 	mutex_exit(&sc->sc_lock);
    228        1.5  jmcneill 
    229        1.5  jmcneill 	if (ISDTVDEMUX(dev))
    230        1.5  jmcneill 		return dtv_demux_open(sc, flags, mode, l);
    231        1.1  jmcneill 
    232        1.1  jmcneill 	return 0;
    233        1.1  jmcneill }
    234        1.1  jmcneill 
    235        1.1  jmcneill static int
    236        1.1  jmcneill dtvclose(dev_t dev, int flags, int mode, lwp_t *l)
    237        1.1  jmcneill {
    238        1.1  jmcneill 	struct dtv_softc *sc;
    239        1.1  jmcneill 
    240        1.1  jmcneill 	if ((sc = device_lookup_private(&dtv_cd, DTVUNIT(dev))) == NULL)
    241        1.1  jmcneill 		return ENXIO;
    242        1.1  jmcneill 
    243        1.7  jmcneill 	dtv_common_close(sc);
    244        1.1  jmcneill 
    245        1.1  jmcneill 	return 0;
    246        1.1  jmcneill }
    247        1.1  jmcneill 
    248        1.1  jmcneill static int
    249        1.1  jmcneill dtvread(dev_t dev, struct uio *uio, int flags)
    250        1.1  jmcneill {
    251        1.1  jmcneill 	struct dtv_softc *sc;
    252        1.1  jmcneill 
    253        1.1  jmcneill 	if ((sc = device_lookup_private(&dtv_cd, DTVUNIT(dev))) == NULL)
    254        1.1  jmcneill 		return ENXIO;
    255        1.1  jmcneill 
    256        1.1  jmcneill 	if (ISDTVDVR(dev))
    257        1.1  jmcneill 		return dtv_buffer_read(sc, uio, flags);
    258        1.1  jmcneill 
    259        1.1  jmcneill 	return ENXIO;
    260        1.1  jmcneill }
    261        1.1  jmcneill 
    262        1.1  jmcneill static int
    263        1.1  jmcneill dtvioctl(dev_t dev, u_long cmd, void *ptr, int flags, lwp_t *l)
    264        1.1  jmcneill {
    265        1.1  jmcneill 	struct dtv_softc *sc;
    266        1.1  jmcneill 
    267        1.1  jmcneill 	if ((sc = device_lookup_private(&dtv_cd, DTVUNIT(dev))) == NULL)
    268        1.1  jmcneill 		return ENXIO;
    269        1.1  jmcneill 
    270        1.1  jmcneill 	if (ISDTVFRONTEND(dev)) {
    271        1.1  jmcneill 		return dtv_frontend_ioctl(sc, cmd, ptr, flags);
    272        1.1  jmcneill 	}
    273        1.1  jmcneill 
    274        1.1  jmcneill 	return EINVAL;
    275        1.1  jmcneill }
    276        1.1  jmcneill 
    277        1.1  jmcneill static int
    278        1.1  jmcneill dtvpoll(dev_t dev, int events, lwp_t *l)
    279        1.1  jmcneill {
    280        1.1  jmcneill 	struct dtv_softc *sc;
    281        1.1  jmcneill 
    282        1.1  jmcneill 	if ((sc = device_lookup_private(&dtv_cd, DTVUNIT(dev))) == NULL)
    283        1.1  jmcneill 		return POLLERR;
    284        1.1  jmcneill 
    285        1.1  jmcneill 	if (ISDTVFRONTEND(dev)) {
    286        1.1  jmcneill 		return POLLPRI|POLLIN; /* XXX event */
    287        1.1  jmcneill 	} else if (ISDTVDVR(dev)) {
    288        1.1  jmcneill 		return dtv_buffer_poll(sc, events, l);
    289        1.1  jmcneill 	}
    290        1.1  jmcneill 
    291        1.1  jmcneill 	return POLLERR;
    292        1.1  jmcneill }
    293        1.1  jmcneill 
    294        1.5  jmcneill void
    295        1.7  jmcneill dtv_common_close(struct dtv_softc *sc)
    296        1.5  jmcneill {
    297        1.5  jmcneill 	mutex_enter(&sc->sc_lock);
    298        1.5  jmcneill 	KASSERT(sc->sc_open > 0);
    299        1.5  jmcneill 	--sc->sc_open;
    300        1.5  jmcneill 	if (sc->sc_open == 0) {
    301        1.5  jmcneill 		dtv_device_close(sc);
    302        1.5  jmcneill 		dtv_buffer_destroy(sc);
    303        1.5  jmcneill 	}
    304        1.5  jmcneill 	mutex_exit(&sc->sc_lock);
    305        1.5  jmcneill }
    306