dtv_device.c revision 1.13 1 1.13 skrll /* $NetBSD: dtv_device.c,v 1.13 2021/07/24 07:48:38 skrll 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.13 skrll __KERNEL_RCSID(0, "$NetBSD: dtv_device.c,v 1.13 2021/07/24 07:48:38 skrll Exp $");
37 1.1 jmcneill
38 1.13 skrll #include <sys/param.h>
39 1.1 jmcneill #include <sys/types.h>
40 1.13 skrll #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