pps_ppbus.c revision 1.2.4.4 1 1.2.4.4 yamt /* $NetBSD: pps_ppbus.c,v 1.2.4.4 2008/01/21 09:44:29 yamt Exp $ */
2 1.1 drochner
3 1.1 drochner /*
4 1.2.4.1 yamt * ported to timecounters by Frank Kardel 2006
5 1.2.4.1 yamt *
6 1.1 drochner * Copyright (c) 2004
7 1.1 drochner * Matthias Drochner. All rights reserved.
8 1.1 drochner *
9 1.1 drochner * Redistribution and use in source and binary forms, with or without
10 1.1 drochner * modification, are permitted provided that the following conditions
11 1.1 drochner * are met:
12 1.1 drochner * 1. Redistributions of source code must retain the above copyright
13 1.1 drochner * notice, this list of conditions, and the following disclaimer.
14 1.1 drochner * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 drochner * notice, this list of conditions and the following disclaimer in the
16 1.1 drochner * documentation and/or other materials provided with the distribution.
17 1.1 drochner *
18 1.1 drochner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19 1.1 drochner * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 1.1 drochner * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 1.1 drochner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22 1.1 drochner * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 1.1 drochner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24 1.1 drochner * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 1.1 drochner * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 1.1 drochner * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 1.1 drochner * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 1.1 drochner * SUCH DAMAGE.
29 1.1 drochner */
30 1.1 drochner
31 1.1 drochner #include <sys/cdefs.h>
32 1.2.4.4 yamt __KERNEL_RCSID(0, "$NetBSD: pps_ppbus.c,v 1.2.4.4 2008/01/21 09:44:29 yamt Exp $");
33 1.1 drochner
34 1.1 drochner #include "opt_ntp.h"
35 1.1 drochner
36 1.1 drochner #include <sys/param.h>
37 1.1 drochner #include <sys/systm.h>
38 1.1 drochner #include <sys/conf.h>
39 1.1 drochner #include <sys/proc.h>
40 1.1 drochner #include <sys/ioctl.h>
41 1.1 drochner #include <sys/timepps.h>
42 1.1 drochner
43 1.1 drochner #include <dev/ppbus/ppbus_base.h>
44 1.1 drochner #include <dev/ppbus/ppbus_device.h>
45 1.1 drochner #include <dev/ppbus/ppbus_io.h>
46 1.1 drochner #include <dev/ppbus/ppbus_var.h>
47 1.1 drochner
48 1.1 drochner struct pps_softc {
49 1.2 perry struct ppbus_device_softc pps_dev;
50 1.1 drochner struct device *ppbus;
51 1.1 drochner int busy;
52 1.2.4.1 yamt struct pps_state pps_state; /* pps state */
53 1.1 drochner };
54 1.1 drochner
55 1.1 drochner static int pps_probe(struct device *, struct cfdata *, void *);
56 1.1 drochner static void pps_attach(struct device *, struct device *, void *);
57 1.2 perry CFATTACH_DECL(pps, sizeof(struct pps_softc), pps_probe, pps_attach,
58 1.1 drochner NULL, NULL);
59 1.1 drochner extern struct cfdriver pps_cd;
60 1.1 drochner
61 1.1 drochner static dev_type_open(ppsopen);
62 1.1 drochner static dev_type_close(ppsclose);
63 1.1 drochner static dev_type_ioctl(ppsioctl);
64 1.1 drochner const struct cdevsw pps_cdevsw = {
65 1.1 drochner ppsopen, ppsclose, noread, nowrite, ppsioctl,
66 1.2.4.2 yamt nostop, notty, nopoll, nommap, nokqfilter, D_OTHER
67 1.1 drochner };
68 1.1 drochner
69 1.1 drochner static void ppsintr(void *arg);
70 1.1 drochner
71 1.1 drochner static int
72 1.1 drochner pps_probe(struct device *parent, struct cfdata *match, void *aux)
73 1.1 drochner {
74 1.1 drochner struct ppbus_attach_args *args = aux;
75 1.1 drochner
76 1.2 perry /* we need an interrupt */
77 1.1 drochner if (!(args->capabilities & PPBUS_HAS_INTR))
78 1.1 drochner return 0;
79 1.1 drochner
80 1.1 drochner return 1;
81 1.1 drochner }
82 1.1 drochner
83 1.1 drochner static void
84 1.1 drochner pps_attach(struct device *parent, struct device *self, void *aux)
85 1.1 drochner {
86 1.2.4.1 yamt struct pps_softc *sc = device_private(self);
87 1.1 drochner
88 1.1 drochner sc->ppbus = parent;
89 1.1 drochner
90 1.1 drochner printf("\n");
91 1.1 drochner }
92 1.1 drochner
93 1.1 drochner static int
94 1.2.4.1 yamt ppsopen(dev_t dev, int flags, int fmt, struct lwp *l)
95 1.1 drochner {
96 1.1 drochner struct pps_softc *sc;
97 1.2.4.1 yamt int res, weg = 0;
98 1.1 drochner
99 1.1 drochner sc = device_lookup(&pps_cd, minor(dev));
100 1.1 drochner if (!sc)
101 1.1 drochner return (ENXIO);
102 1.1 drochner
103 1.1 drochner if (sc->busy)
104 1.1 drochner return (0);
105 1.1 drochner
106 1.1 drochner if (ppbus_request_bus(sc->ppbus, &sc->pps_dev.sc_dev,
107 1.1 drochner PPBUS_WAIT|PPBUS_INTR, 0))
108 1.1 drochner return (EINTR);
109 1.1 drochner
110 1.2.4.1 yamt ppbus_write_ivar(sc->ppbus, PPBUS_IVAR_IEEE, &weg);
111 1.2.4.1 yamt
112 1.1 drochner /* attach the interrupt handler */
113 1.1 drochner /* XXX priority should be set here */
114 1.1 drochner res = ppbus_add_handler(sc->ppbus, ppsintr, sc);
115 1.1 drochner if (res) {
116 1.1 drochner ppbus_release_bus(sc->ppbus, &sc->pps_dev.sc_dev,
117 1.1 drochner PPBUS_WAIT, 0);
118 1.1 drochner return (res);
119 1.1 drochner }
120 1.1 drochner
121 1.1 drochner ppbus_set_mode(sc->ppbus, PPBUS_PS2, 0);
122 1.1 drochner ppbus_wctr(sc->ppbus, IRQENABLE | PCD | nINIT | SELECTIN);
123 1.1 drochner
124 1.2.4.1 yamt memset((void *)&sc->pps_state, 0, sizeof(sc->pps_state));
125 1.2.4.1 yamt sc->pps_state.ppscap = PPS_CAPTUREASSERT;
126 1.2.4.1 yamt pps_init(&sc->pps_state);
127 1.2.4.1 yamt
128 1.1 drochner sc->busy = 1;
129 1.1 drochner return (0);
130 1.1 drochner }
131 1.1 drochner
132 1.1 drochner static int
133 1.2.4.1 yamt ppsclose(dev_t dev, int flags, int fmt, struct lwp *l)
134 1.1 drochner {
135 1.1 drochner struct pps_softc *sc = device_lookup(&pps_cd, minor(dev));
136 1.1 drochner struct device *ppbus = sc->ppbus;
137 1.1 drochner
138 1.1 drochner sc->busy = 0;
139 1.2.4.1 yamt sc->pps_state.ppsparam.mode = 0;
140 1.2.4.1 yamt
141 1.1 drochner ppbus_wdtr(ppbus, 0);
142 1.1 drochner ppbus_wctr(ppbus, 0);
143 1.1 drochner
144 1.1 drochner ppbus_remove_handler(ppbus, ppsintr);
145 1.1 drochner ppbus_set_mode(ppbus, PPBUS_COMPATIBLE, 0);
146 1.1 drochner ppbus_release_bus(ppbus, &sc->pps_dev.sc_dev, PPBUS_WAIT, 0);
147 1.1 drochner return (0);
148 1.1 drochner }
149 1.1 drochner
150 1.1 drochner static void
151 1.1 drochner ppsintr(void *arg)
152 1.1 drochner {
153 1.1 drochner struct pps_softc *sc = arg;
154 1.1 drochner struct device *ppbus = sc->ppbus;
155 1.1 drochner
156 1.2.4.1 yamt pps_capture(&sc->pps_state);
157 1.2.4.1 yamt
158 1.1 drochner if (!(ppbus_rstr(ppbus) & nACK))
159 1.1 drochner return;
160 1.1 drochner
161 1.2.4.1 yamt if (sc->pps_state.ppsparam.mode & PPS_ECHOASSERT)
162 1.2.4.1 yamt ppbus_wctr(ppbus, IRQENABLE | AUTOFEED);
163 1.2.4.1 yamt
164 1.2.4.1 yamt pps_event(&sc->pps_state, PPS_CAPTUREASSERT);
165 1.2.4.1 yamt
166 1.2.4.1 yamt if (sc->pps_state.ppsparam.mode & PPS_ECHOASSERT)
167 1.2.4.1 yamt ppbus_wctr(ppbus, IRQENABLE);
168 1.1 drochner }
169 1.1 drochner
170 1.1 drochner static int
171 1.2.4.3 yamt ppsioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
172 1.1 drochner {
173 1.1 drochner struct pps_softc *sc = device_lookup(&pps_cd, minor(dev));
174 1.1 drochner int error = 0;
175 1.1 drochner
176 1.1 drochner switch (cmd) {
177 1.2.4.1 yamt case PPS_IOC_CREATE:
178 1.2.4.1 yamt case PPS_IOC_DESTROY:
179 1.2.4.1 yamt case PPS_IOC_GETPARAMS:
180 1.2.4.1 yamt case PPS_IOC_SETPARAMS:
181 1.2.4.1 yamt case PPS_IOC_GETCAP:
182 1.2.4.1 yamt case PPS_IOC_FETCH:
183 1.2.4.1 yamt #ifdef PPS_SYNC
184 1.2.4.1 yamt case PPS_IOC_KCBIND:
185 1.2.4.1 yamt #endif
186 1.2.4.1 yamt error = pps_ioctl(cmd, data, &sc->pps_state);
187 1.2.4.1 yamt break;
188 1.1 drochner
189 1.1 drochner default:
190 1.1 drochner error = EPASSTHROUGH;
191 1.1 drochner break;
192 1.1 drochner }
193 1.1 drochner return (error);
194 1.1 drochner }
195