1b4dbc599SNathan Whitehorn /*-
271e3c308SPedro F. Giffuni * SPDX-License-Identifier: BSD-3-Clause
371e3c308SPedro F. Giffuni *
4b4dbc599SNathan Whitehorn * Copyright (c) 2006 Michael Lorenz
5b4dbc599SNathan Whitehorn * Copyright 2008 by Nathan Whitehorn
6b4dbc599SNathan Whitehorn * All rights reserved.
7b4dbc599SNathan Whitehorn *
8b4dbc599SNathan Whitehorn * Redistribution and use in source and binary forms, with or without
9b4dbc599SNathan Whitehorn * modification, are permitted provided that the following conditions
10b4dbc599SNathan Whitehorn * are met:
11b4dbc599SNathan Whitehorn * 1. Redistributions of source code must retain the above copyright
12b4dbc599SNathan Whitehorn * notice, this list of conditions and the following disclaimer.
13b4dbc599SNathan Whitehorn * 2. Redistributions in binary form must reproduce the above copyright
14b4dbc599SNathan Whitehorn * notice, this list of conditions and the following disclaimer in the
15b4dbc599SNathan Whitehorn * documentation and/or other materials provided with the distribution.
16b4dbc599SNathan Whitehorn * 3. The name of the author may not be used to endorse or promote products
17b4dbc599SNathan Whitehorn * derived from this software without specific prior written permission.
18b4dbc599SNathan Whitehorn *
19b4dbc599SNathan Whitehorn * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20b4dbc599SNathan Whitehorn * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21b4dbc599SNathan Whitehorn * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22b4dbc599SNathan Whitehorn * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23b4dbc599SNathan Whitehorn * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
24b4dbc599SNathan Whitehorn * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
25b4dbc599SNathan Whitehorn * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
26b4dbc599SNathan Whitehorn * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
27b4dbc599SNathan Whitehorn * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28b4dbc599SNathan Whitehorn * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29b4dbc599SNathan Whitehorn * SUCH DAMAGE.
30b4dbc599SNathan Whitehorn *
31b4dbc599SNathan Whitehorn */
32b4dbc599SNathan Whitehorn
33b4dbc599SNathan Whitehorn #include <sys/param.h>
34b4dbc599SNathan Whitehorn #include <sys/systm.h>
35b4dbc599SNathan Whitehorn #include <sys/module.h>
36b4dbc599SNathan Whitehorn #include <sys/bus.h>
37b4dbc599SNathan Whitehorn #include <sys/conf.h>
38e2e050c8SConrad Meyer #include <sys/eventhandler.h>
39b4dbc599SNathan Whitehorn #include <sys/kernel.h>
40e2e050c8SConrad Meyer #include <sys/lock.h>
41e2e050c8SConrad Meyer #include <sys/mutex.h>
423df9e037SNathan Whitehorn #include <sys/clock.h>
43b2a237beSNathan Whitehorn #include <sys/reboot.h>
44b4dbc599SNathan Whitehorn
45b4dbc599SNathan Whitehorn #include <dev/ofw/ofw_bus.h>
46b4dbc599SNathan Whitehorn #include <dev/ofw/openfirm.h>
47b4dbc599SNathan Whitehorn
48b4dbc599SNathan Whitehorn #include <machine/bus.h>
49b4dbc599SNathan Whitehorn #include <machine/intr_machdep.h>
50b4dbc599SNathan Whitehorn #include <machine/md_var.h>
51b4dbc599SNathan Whitehorn #include <machine/pio.h>
52b4dbc599SNathan Whitehorn #include <machine/resource.h>
53b4dbc599SNathan Whitehorn
54b4dbc599SNathan Whitehorn #include <vm/vm.h>
55b4dbc599SNathan Whitehorn #include <vm/pmap.h>
56b4dbc599SNathan Whitehorn
57b4dbc599SNathan Whitehorn #include <sys/rman.h>
58b4dbc599SNathan Whitehorn
59b4dbc599SNathan Whitehorn #include <dev/adb/adb.h>
60b4dbc599SNathan Whitehorn
613df9e037SNathan Whitehorn #include "clock_if.h"
62b4dbc599SNathan Whitehorn #include "cudavar.h"
63b4dbc599SNathan Whitehorn #include "viareg.h"
64b4dbc599SNathan Whitehorn
65b4dbc599SNathan Whitehorn /*
66b4dbc599SNathan Whitehorn * MacIO interface
67b4dbc599SNathan Whitehorn */
68b4dbc599SNathan Whitehorn static int cuda_probe(device_t);
69b4dbc599SNathan Whitehorn static int cuda_attach(device_t);
70b4dbc599SNathan Whitehorn static int cuda_detach(device_t);
71b4dbc599SNathan Whitehorn
72b4dbc599SNathan Whitehorn static u_int cuda_adb_send(device_t dev, u_char command_byte, int len,
73b4dbc599SNathan Whitehorn u_char *data, u_char poll);
74b4dbc599SNathan Whitehorn static u_int cuda_adb_autopoll(device_t dev, uint16_t mask);
7565f44679SAndriy Gapon static u_int cuda_poll(device_t dev);
76582434bdSNathan Whitehorn static void cuda_send_inbound(struct cuda_softc *sc);
77582434bdSNathan Whitehorn static void cuda_send_outbound(struct cuda_softc *sc);
78b2a237beSNathan Whitehorn static void cuda_shutdown(void *xsc, int howto);
79b4dbc599SNathan Whitehorn
803df9e037SNathan Whitehorn /*
813df9e037SNathan Whitehorn * Clock interface
823df9e037SNathan Whitehorn */
833df9e037SNathan Whitehorn static int cuda_gettime(device_t dev, struct timespec *ts);
843df9e037SNathan Whitehorn static int cuda_settime(device_t dev, struct timespec *ts);
853df9e037SNathan Whitehorn
86b4dbc599SNathan Whitehorn static device_method_t cuda_methods[] = {
87b4dbc599SNathan Whitehorn /* Device interface */
88b4dbc599SNathan Whitehorn DEVMETHOD(device_probe, cuda_probe),
89b4dbc599SNathan Whitehorn DEVMETHOD(device_attach, cuda_attach),
90b4dbc599SNathan Whitehorn DEVMETHOD(device_detach, cuda_detach),
91b4dbc599SNathan Whitehorn DEVMETHOD(device_shutdown, bus_generic_shutdown),
92b4dbc599SNathan Whitehorn DEVMETHOD(device_suspend, bus_generic_suspend),
93b4dbc599SNathan Whitehorn DEVMETHOD(device_resume, bus_generic_resume),
94b4dbc599SNathan Whitehorn
95b4dbc599SNathan Whitehorn /* ADB bus interface */
96b4dbc599SNathan Whitehorn DEVMETHOD(adb_hb_send_raw_packet, cuda_adb_send),
97b4dbc599SNathan Whitehorn DEVMETHOD(adb_hb_controller_poll, cuda_poll),
98b4dbc599SNathan Whitehorn DEVMETHOD(adb_hb_set_autopoll_mask, cuda_adb_autopoll),
99b4dbc599SNathan Whitehorn
1003df9e037SNathan Whitehorn /* Clock interface */
1013df9e037SNathan Whitehorn DEVMETHOD(clock_gettime, cuda_gettime),
1023df9e037SNathan Whitehorn DEVMETHOD(clock_settime, cuda_settime),
1033df9e037SNathan Whitehorn
1044b7ec270SMarius Strobl DEVMETHOD_END
105b4dbc599SNathan Whitehorn };
106b4dbc599SNathan Whitehorn
107b4dbc599SNathan Whitehorn static driver_t cuda_driver = {
108b4dbc599SNathan Whitehorn "cuda",
109b4dbc599SNathan Whitehorn cuda_methods,
110b4dbc599SNathan Whitehorn sizeof(struct cuda_softc),
111b4dbc599SNathan Whitehorn };
112b4dbc599SNathan Whitehorn
113992ae60bSJohn Baldwin DRIVER_MODULE(cuda, macio, cuda_driver, 0, 0);
11442f777fcSJohn Baldwin DRIVER_MODULE(adb, cuda, adb_driver, 0, 0);
115b4dbc599SNathan Whitehorn
116b4dbc599SNathan Whitehorn static void cuda_intr(void *arg);
117b4dbc599SNathan Whitehorn static uint8_t cuda_read_reg(struct cuda_softc *sc, u_int offset);
118b4dbc599SNathan Whitehorn static void cuda_write_reg(struct cuda_softc *sc, u_int offset, uint8_t value);
119b4dbc599SNathan Whitehorn static void cuda_idle(struct cuda_softc *);
120b4dbc599SNathan Whitehorn static void cuda_tip(struct cuda_softc *);
121b4dbc599SNathan Whitehorn static void cuda_clear_tip(struct cuda_softc *);
122b4dbc599SNathan Whitehorn static void cuda_in(struct cuda_softc *);
123b4dbc599SNathan Whitehorn static void cuda_out(struct cuda_softc *);
124b4dbc599SNathan Whitehorn static void cuda_toggle_ack(struct cuda_softc *);
125b4dbc599SNathan Whitehorn static void cuda_ack_off(struct cuda_softc *);
126b4dbc599SNathan Whitehorn static int cuda_intr_state(struct cuda_softc *);
127b4dbc599SNathan Whitehorn
128b4dbc599SNathan Whitehorn static int
cuda_probe(device_t dev)129b4dbc599SNathan Whitehorn cuda_probe(device_t dev)
130b4dbc599SNathan Whitehorn {
131b4dbc599SNathan Whitehorn const char *type = ofw_bus_get_type(dev);
132b4dbc599SNathan Whitehorn
133b4dbc599SNathan Whitehorn if (strcmp(type, "via-cuda") != 0)
134b4dbc599SNathan Whitehorn return (ENXIO);
135b4dbc599SNathan Whitehorn
136b4dbc599SNathan Whitehorn device_set_desc(dev, CUDA_DEVSTR);
137b4dbc599SNathan Whitehorn return (0);
138b4dbc599SNathan Whitehorn }
139b4dbc599SNathan Whitehorn
140b4dbc599SNathan Whitehorn static int
cuda_attach(device_t dev)141b4dbc599SNathan Whitehorn cuda_attach(device_t dev)
142b4dbc599SNathan Whitehorn {
143b4dbc599SNathan Whitehorn struct cuda_softc *sc;
144b4dbc599SNathan Whitehorn
145b4dbc599SNathan Whitehorn volatile int i;
146b4dbc599SNathan Whitehorn uint8_t reg;
147b4dbc599SNathan Whitehorn phandle_t node,child;
148b4dbc599SNathan Whitehorn
149b4dbc599SNathan Whitehorn sc = device_get_softc(dev);
150b4dbc599SNathan Whitehorn sc->sc_dev = dev;
151b4dbc599SNathan Whitehorn
152b4dbc599SNathan Whitehorn sc->sc_memrid = 0;
153b4dbc599SNathan Whitehorn sc->sc_memr = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
154b4dbc599SNathan Whitehorn &sc->sc_memrid, RF_ACTIVE);
155b4dbc599SNathan Whitehorn
156b4dbc599SNathan Whitehorn if (sc->sc_memr == NULL) {
157b4dbc599SNathan Whitehorn device_printf(dev, "Could not alloc mem resource!\n");
158b4dbc599SNathan Whitehorn return (ENXIO);
159b4dbc599SNathan Whitehorn }
160b4dbc599SNathan Whitehorn
161b4dbc599SNathan Whitehorn sc->sc_irqrid = 0;
162b4dbc599SNathan Whitehorn sc->sc_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sc_irqrid,
163b4dbc599SNathan Whitehorn RF_ACTIVE);
164b4dbc599SNathan Whitehorn if (sc->sc_irq == NULL) {
165b4dbc599SNathan Whitehorn device_printf(dev, "could not allocate interrupt\n");
166596e6adeSAlexander Motin bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_memrid,
167596e6adeSAlexander Motin sc->sc_memr);
168b4dbc599SNathan Whitehorn return (ENXIO);
169b4dbc599SNathan Whitehorn }
170b4dbc599SNathan Whitehorn
171b4dbc599SNathan Whitehorn if (bus_setup_intr(dev, sc->sc_irq, INTR_TYPE_MISC | INTR_MPSAFE
172b4dbc599SNathan Whitehorn | INTR_ENTROPY, NULL, cuda_intr, dev, &sc->sc_ih) != 0) {
173b4dbc599SNathan Whitehorn device_printf(dev, "could not setup interrupt\n");
174596e6adeSAlexander Motin bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_memrid,
175596e6adeSAlexander Motin sc->sc_memr);
176b4dbc599SNathan Whitehorn bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irqrid,
177b4dbc599SNathan Whitehorn sc->sc_irq);
178b4dbc599SNathan Whitehorn return (ENXIO);
179b4dbc599SNathan Whitehorn }
180b4dbc599SNathan Whitehorn
181b4dbc599SNathan Whitehorn mtx_init(&sc->sc_mutex,"cuda",NULL,MTX_DEF | MTX_RECURSE);
182b4dbc599SNathan Whitehorn
183b4dbc599SNathan Whitehorn sc->sc_sent = 0;
184b4dbc599SNathan Whitehorn sc->sc_received = 0;
185b4dbc599SNathan Whitehorn sc->sc_waiting = 0;
186b4dbc599SNathan Whitehorn sc->sc_polling = 0;
187b4dbc599SNathan Whitehorn sc->sc_state = CUDA_NOTREADY;
188b4dbc599SNathan Whitehorn sc->sc_autopoll = 0;
1893df9e037SNathan Whitehorn sc->sc_rtc = -1;
190b4dbc599SNathan Whitehorn
191582434bdSNathan Whitehorn STAILQ_INIT(&sc->sc_inq);
192582434bdSNathan Whitehorn STAILQ_INIT(&sc->sc_outq);
193011ad8e7SNathan Whitehorn STAILQ_INIT(&sc->sc_freeq);
194011ad8e7SNathan Whitehorn
195011ad8e7SNathan Whitehorn for (i = 0; i < CUDA_MAXPACKETS; i++)
196011ad8e7SNathan Whitehorn STAILQ_INSERT_TAIL(&sc->sc_freeq, &sc->sc_pkts[i], pkt_q);
197582434bdSNathan Whitehorn
198b4dbc599SNathan Whitehorn /* Init CUDA */
199b4dbc599SNathan Whitehorn
200b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vDirB);
201b4dbc599SNathan Whitehorn reg |= 0x30; /* register B bits 4 and 5: outputs */
202b4dbc599SNathan Whitehorn cuda_write_reg(sc, vDirB, reg);
203b4dbc599SNathan Whitehorn
204b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vDirB);
205b4dbc599SNathan Whitehorn reg &= 0xf7; /* register B bit 3: input */
206b4dbc599SNathan Whitehorn cuda_write_reg(sc, vDirB, reg);
207b4dbc599SNathan Whitehorn
208b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vACR);
209b4dbc599SNathan Whitehorn reg &= ~vSR_OUT; /* make sure SR is set to IN */
210b4dbc599SNathan Whitehorn cuda_write_reg(sc, vACR, reg);
211b4dbc599SNathan Whitehorn
212b4dbc599SNathan Whitehorn cuda_write_reg(sc, vACR, (cuda_read_reg(sc, vACR) | 0x0c) & ~0x10);
213b4dbc599SNathan Whitehorn
214b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IDLE; /* used by all types of hardware */
215b4dbc599SNathan Whitehorn
216b4dbc599SNathan Whitehorn cuda_write_reg(sc, vIER, 0x84); /* make sure VIA interrupts are on */
217b4dbc599SNathan Whitehorn
218b4dbc599SNathan Whitehorn cuda_idle(sc); /* reset ADB */
219b4dbc599SNathan Whitehorn
220b4dbc599SNathan Whitehorn /* Reset CUDA */
221b4dbc599SNathan Whitehorn
222b4dbc599SNathan Whitehorn i = cuda_read_reg(sc, vSR); /* clear interrupt */
223b4dbc599SNathan Whitehorn cuda_write_reg(sc, vIER, 0x04); /* no interrupts while clearing */
224b4dbc599SNathan Whitehorn cuda_idle(sc); /* reset state to idle */
225b4dbc599SNathan Whitehorn DELAY(150);
226b4dbc599SNathan Whitehorn cuda_tip(sc); /* signal start of frame */
227b4dbc599SNathan Whitehorn DELAY(150);
228b4dbc599SNathan Whitehorn cuda_toggle_ack(sc);
229b4dbc599SNathan Whitehorn DELAY(150);
230b4dbc599SNathan Whitehorn cuda_clear_tip(sc);
231b4dbc599SNathan Whitehorn DELAY(150);
232b4dbc599SNathan Whitehorn cuda_idle(sc); /* back to idle state */
233b4dbc599SNathan Whitehorn i = cuda_read_reg(sc, vSR); /* clear interrupt */
234b4dbc599SNathan Whitehorn cuda_write_reg(sc, vIER, 0x84); /* ints ok now */
235b4dbc599SNathan Whitehorn
236b4dbc599SNathan Whitehorn /* Initialize child buses (ADB) */
237b4dbc599SNathan Whitehorn node = ofw_bus_get_node(dev);
238b4dbc599SNathan Whitehorn
239b4dbc599SNathan Whitehorn for (child = OF_child(node); child != 0; child = OF_peer(child)) {
240b4dbc599SNathan Whitehorn char name[32];
241b4dbc599SNathan Whitehorn
242b4dbc599SNathan Whitehorn memset(name, 0, sizeof(name));
243b4dbc599SNathan Whitehorn OF_getprop(child, "name", name, sizeof(name));
244b4dbc599SNathan Whitehorn
245b4dbc599SNathan Whitehorn if (bootverbose)
246b4dbc599SNathan Whitehorn device_printf(dev, "CUDA child <%s>\n",name);
247b4dbc599SNathan Whitehorn
248b4dbc599SNathan Whitehorn if (strncmp(name, "adb", 4) == 0) {
2495b56413dSWarner Losh sc->adb_bus = device_add_child(dev,"adb",DEVICE_UNIT_ANY);
250b4dbc599SNathan Whitehorn }
251b4dbc599SNathan Whitehorn }
252b4dbc599SNathan Whitehorn
2533df9e037SNathan Whitehorn clock_register(dev, 1000);
254b2a237beSNathan Whitehorn EVENTHANDLER_REGISTER(shutdown_final, cuda_shutdown, sc,
255b2a237beSNathan Whitehorn SHUTDOWN_PRI_LAST);
2563df9e037SNathan Whitehorn
257*18250ec6SJohn Baldwin bus_attach_children(dev);
258*18250ec6SJohn Baldwin return (0);
259b4dbc599SNathan Whitehorn }
260b4dbc599SNathan Whitehorn
cuda_detach(device_t dev)261b4dbc599SNathan Whitehorn static int cuda_detach(device_t dev) {
262b4dbc599SNathan Whitehorn struct cuda_softc *sc;
263d412c076SJohn Baldwin int error;
264d412c076SJohn Baldwin
265d412c076SJohn Baldwin error = bus_generic_detach(dev);
266d412c076SJohn Baldwin if (error != 0)
267d412c076SJohn Baldwin return (error);
268b4dbc599SNathan Whitehorn
269b4dbc599SNathan Whitehorn sc = device_get_softc(dev);
270b4dbc599SNathan Whitehorn
271b4dbc599SNathan Whitehorn bus_teardown_intr(dev, sc->sc_irq, sc->sc_ih);
272b4dbc599SNathan Whitehorn bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irqrid, sc->sc_irq);
273b4dbc599SNathan Whitehorn bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_memrid, sc->sc_memr);
274b4dbc599SNathan Whitehorn mtx_destroy(&sc->sc_mutex);
275b4dbc599SNathan Whitehorn
276d412c076SJohn Baldwin return (0);
277b4dbc599SNathan Whitehorn }
278b4dbc599SNathan Whitehorn
279b4dbc599SNathan Whitehorn static uint8_t
cuda_read_reg(struct cuda_softc * sc,u_int offset)280b4dbc599SNathan Whitehorn cuda_read_reg(struct cuda_softc *sc, u_int offset) {
281b4dbc599SNathan Whitehorn return (bus_read_1(sc->sc_memr, offset));
282b4dbc599SNathan Whitehorn }
283b4dbc599SNathan Whitehorn
284b4dbc599SNathan Whitehorn static void
cuda_write_reg(struct cuda_softc * sc,u_int offset,uint8_t value)285b4dbc599SNathan Whitehorn cuda_write_reg(struct cuda_softc *sc, u_int offset, uint8_t value) {
286b4dbc599SNathan Whitehorn bus_write_1(sc->sc_memr, offset, value);
287b4dbc599SNathan Whitehorn }
288b4dbc599SNathan Whitehorn
289b4dbc599SNathan Whitehorn static void
cuda_idle(struct cuda_softc * sc)290b4dbc599SNathan Whitehorn cuda_idle(struct cuda_softc *sc)
291b4dbc599SNathan Whitehorn {
292b4dbc599SNathan Whitehorn uint8_t reg;
293b4dbc599SNathan Whitehorn
294b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vBufB);
295b4dbc599SNathan Whitehorn reg |= (vPB4 | vPB5);
296b4dbc599SNathan Whitehorn cuda_write_reg(sc, vBufB, reg);
297b4dbc599SNathan Whitehorn }
298b4dbc599SNathan Whitehorn
299b4dbc599SNathan Whitehorn static void
cuda_tip(struct cuda_softc * sc)300b4dbc599SNathan Whitehorn cuda_tip(struct cuda_softc *sc)
301b4dbc599SNathan Whitehorn {
302b4dbc599SNathan Whitehorn uint8_t reg;
303b4dbc599SNathan Whitehorn
304b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vBufB);
305b4dbc599SNathan Whitehorn reg &= ~vPB5;
306b4dbc599SNathan Whitehorn cuda_write_reg(sc, vBufB, reg);
307b4dbc599SNathan Whitehorn }
308b4dbc599SNathan Whitehorn
309b4dbc599SNathan Whitehorn static void
cuda_clear_tip(struct cuda_softc * sc)310b4dbc599SNathan Whitehorn cuda_clear_tip(struct cuda_softc *sc)
311b4dbc599SNathan Whitehorn {
312b4dbc599SNathan Whitehorn uint8_t reg;
313b4dbc599SNathan Whitehorn
314b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vBufB);
315b4dbc599SNathan Whitehorn reg |= vPB5;
316b4dbc599SNathan Whitehorn cuda_write_reg(sc, vBufB, reg);
317b4dbc599SNathan Whitehorn }
318b4dbc599SNathan Whitehorn
319b4dbc599SNathan Whitehorn static void
cuda_in(struct cuda_softc * sc)320b4dbc599SNathan Whitehorn cuda_in(struct cuda_softc *sc)
321b4dbc599SNathan Whitehorn {
322b4dbc599SNathan Whitehorn uint8_t reg;
323b4dbc599SNathan Whitehorn
324b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vACR);
325b4dbc599SNathan Whitehorn reg &= ~vSR_OUT;
326b4dbc599SNathan Whitehorn cuda_write_reg(sc, vACR, reg);
327b4dbc599SNathan Whitehorn }
328b4dbc599SNathan Whitehorn
329b4dbc599SNathan Whitehorn static void
cuda_out(struct cuda_softc * sc)330b4dbc599SNathan Whitehorn cuda_out(struct cuda_softc *sc)
331b4dbc599SNathan Whitehorn {
332b4dbc599SNathan Whitehorn uint8_t reg;
333b4dbc599SNathan Whitehorn
334b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vACR);
335b4dbc599SNathan Whitehorn reg |= vSR_OUT;
336b4dbc599SNathan Whitehorn cuda_write_reg(sc, vACR, reg);
337b4dbc599SNathan Whitehorn }
338b4dbc599SNathan Whitehorn
339b4dbc599SNathan Whitehorn static void
cuda_toggle_ack(struct cuda_softc * sc)340b4dbc599SNathan Whitehorn cuda_toggle_ack(struct cuda_softc *sc)
341b4dbc599SNathan Whitehorn {
342b4dbc599SNathan Whitehorn uint8_t reg;
343b4dbc599SNathan Whitehorn
344b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vBufB);
345b4dbc599SNathan Whitehorn reg ^= vPB4;
346b4dbc599SNathan Whitehorn cuda_write_reg(sc, vBufB, reg);
347b4dbc599SNathan Whitehorn }
348b4dbc599SNathan Whitehorn
349b4dbc599SNathan Whitehorn static void
cuda_ack_off(struct cuda_softc * sc)350b4dbc599SNathan Whitehorn cuda_ack_off(struct cuda_softc *sc)
351b4dbc599SNathan Whitehorn {
352b4dbc599SNathan Whitehorn uint8_t reg;
353b4dbc599SNathan Whitehorn
354b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vBufB);
355b4dbc599SNathan Whitehorn reg |= vPB4;
356b4dbc599SNathan Whitehorn cuda_write_reg(sc, vBufB, reg);
357b4dbc599SNathan Whitehorn }
358b4dbc599SNathan Whitehorn
359b4dbc599SNathan Whitehorn static int
cuda_intr_state(struct cuda_softc * sc)360b4dbc599SNathan Whitehorn cuda_intr_state(struct cuda_softc *sc)
361b4dbc599SNathan Whitehorn {
362b4dbc599SNathan Whitehorn return ((cuda_read_reg(sc, vBufB) & vPB3) == 0);
363b4dbc599SNathan Whitehorn }
364b4dbc599SNathan Whitehorn
365b4dbc599SNathan Whitehorn static int
cuda_send(void * cookie,int poll,int length,uint8_t * msg)366b4dbc599SNathan Whitehorn cuda_send(void *cookie, int poll, int length, uint8_t *msg)
367b4dbc599SNathan Whitehorn {
368b4dbc599SNathan Whitehorn struct cuda_softc *sc = cookie;
369b4dbc599SNathan Whitehorn device_t dev = sc->sc_dev;
370582434bdSNathan Whitehorn struct cuda_packet *pkt;
371b4dbc599SNathan Whitehorn
372b4dbc599SNathan Whitehorn if (sc->sc_state == CUDA_NOTREADY)
373582434bdSNathan Whitehorn return (-1);
374b4dbc599SNathan Whitehorn
375b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mutex);
376b4dbc599SNathan Whitehorn
377011ad8e7SNathan Whitehorn pkt = STAILQ_FIRST(&sc->sc_freeq);
378011ad8e7SNathan Whitehorn if (pkt == NULL) {
379011ad8e7SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
380011ad8e7SNathan Whitehorn return (-1);
381011ad8e7SNathan Whitehorn }
382011ad8e7SNathan Whitehorn
383582434bdSNathan Whitehorn pkt->len = length - 1;
384582434bdSNathan Whitehorn pkt->type = msg[0];
385582434bdSNathan Whitehorn memcpy(pkt->data, &msg[1], pkt->len);
386582434bdSNathan Whitehorn
387011ad8e7SNathan Whitehorn STAILQ_REMOVE_HEAD(&sc->sc_freeq, pkt_q);
388582434bdSNathan Whitehorn STAILQ_INSERT_TAIL(&sc->sc_outq, pkt, pkt_q);
389582434bdSNathan Whitehorn
390582434bdSNathan Whitehorn /*
391582434bdSNathan Whitehorn * If we already are sending a packet, we should bail now that this
392582434bdSNathan Whitehorn * one has been added to the queue.
393582434bdSNathan Whitehorn */
394582434bdSNathan Whitehorn
395582434bdSNathan Whitehorn if (sc->sc_waiting) {
396b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
397582434bdSNathan Whitehorn return (0);
398b4dbc599SNathan Whitehorn }
399b4dbc599SNathan Whitehorn
400582434bdSNathan Whitehorn cuda_send_outbound(sc);
401582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
402582434bdSNathan Whitehorn
403582434bdSNathan Whitehorn if (sc->sc_polling || poll || cold)
404582434bdSNathan Whitehorn cuda_poll(dev);
405582434bdSNathan Whitehorn
406582434bdSNathan Whitehorn return (0);
407582434bdSNathan Whitehorn }
408582434bdSNathan Whitehorn
409582434bdSNathan Whitehorn static void
cuda_send_outbound(struct cuda_softc * sc)410582434bdSNathan Whitehorn cuda_send_outbound(struct cuda_softc *sc)
411582434bdSNathan Whitehorn {
412582434bdSNathan Whitehorn struct cuda_packet *pkt;
413582434bdSNathan Whitehorn
414582434bdSNathan Whitehorn mtx_assert(&sc->sc_mutex, MA_OWNED);
415582434bdSNathan Whitehorn
416582434bdSNathan Whitehorn pkt = STAILQ_FIRST(&sc->sc_outq);
417582434bdSNathan Whitehorn if (pkt == NULL)
418582434bdSNathan Whitehorn return;
419582434bdSNathan Whitehorn
420582434bdSNathan Whitehorn sc->sc_out_length = pkt->len + 1;
421582434bdSNathan Whitehorn memcpy(sc->sc_out, &pkt->type, pkt->len + 1);
422b4dbc599SNathan Whitehorn sc->sc_sent = 0;
423b4dbc599SNathan Whitehorn
424582434bdSNathan Whitehorn STAILQ_REMOVE_HEAD(&sc->sc_outq, pkt_q);
425011ad8e7SNathan Whitehorn STAILQ_INSERT_TAIL(&sc->sc_freeq, pkt, pkt_q);
426582434bdSNathan Whitehorn
427582434bdSNathan Whitehorn sc->sc_waiting = 1;
428582434bdSNathan Whitehorn
429582434bdSNathan Whitehorn cuda_poll(sc->sc_dev);
430582434bdSNathan Whitehorn
431b4dbc599SNathan Whitehorn DELAY(150);
432582434bdSNathan Whitehorn
433582434bdSNathan Whitehorn if (sc->sc_state == CUDA_IDLE && !cuda_intr_state(sc)) {
434b4dbc599SNathan Whitehorn sc->sc_state = CUDA_OUT;
435b4dbc599SNathan Whitehorn cuda_out(sc);
436b4dbc599SNathan Whitehorn cuda_write_reg(sc, vSR, sc->sc_out[0]);
437b4dbc599SNathan Whitehorn cuda_ack_off(sc);
438b4dbc599SNathan Whitehorn cuda_tip(sc);
439b4dbc599SNathan Whitehorn }
440b4dbc599SNathan Whitehorn }
441b4dbc599SNathan Whitehorn
442582434bdSNathan Whitehorn static void
cuda_send_inbound(struct cuda_softc * sc)443582434bdSNathan Whitehorn cuda_send_inbound(struct cuda_softc *sc)
444582434bdSNathan Whitehorn {
445582434bdSNathan Whitehorn device_t dev;
446582434bdSNathan Whitehorn struct cuda_packet *pkt;
447582434bdSNathan Whitehorn
448582434bdSNathan Whitehorn dev = sc->sc_dev;
449582434bdSNathan Whitehorn
450582434bdSNathan Whitehorn mtx_lock(&sc->sc_mutex);
451582434bdSNathan Whitehorn
452582434bdSNathan Whitehorn while ((pkt = STAILQ_FIRST(&sc->sc_inq)) != NULL) {
453582434bdSNathan Whitehorn STAILQ_REMOVE_HEAD(&sc->sc_inq, pkt_q);
454582434bdSNathan Whitehorn
455582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
456582434bdSNathan Whitehorn
457582434bdSNathan Whitehorn /* check if we have a handler for this message */
458582434bdSNathan Whitehorn switch (pkt->type) {
459582434bdSNathan Whitehorn case CUDA_ADB:
460582434bdSNathan Whitehorn if (pkt->len > 2) {
461582434bdSNathan Whitehorn adb_receive_raw_packet(sc->adb_bus,
462582434bdSNathan Whitehorn pkt->data[0],pkt->data[1],
463582434bdSNathan Whitehorn pkt->len - 2,&pkt->data[2]);
464582434bdSNathan Whitehorn } else {
465582434bdSNathan Whitehorn adb_receive_raw_packet(sc->adb_bus,
466582434bdSNathan Whitehorn pkt->data[0],pkt->data[1],0,NULL);
467582434bdSNathan Whitehorn }
468582434bdSNathan Whitehorn break;
469582434bdSNathan Whitehorn case CUDA_PSEUDO:
470582434bdSNathan Whitehorn mtx_lock(&sc->sc_mutex);
4713df9e037SNathan Whitehorn switch (pkt->data[1]) {
4723df9e037SNathan Whitehorn case CMD_AUTOPOLL:
473582434bdSNathan Whitehorn sc->sc_autopoll = 1;
4743df9e037SNathan Whitehorn break;
4753df9e037SNathan Whitehorn case CMD_READ_RTC:
4763df9e037SNathan Whitehorn memcpy(&sc->sc_rtc, &pkt->data[2],
4773df9e037SNathan Whitehorn sizeof(sc->sc_rtc));
4783df9e037SNathan Whitehorn wakeup(&sc->sc_rtc);
4793df9e037SNathan Whitehorn break;
4803df9e037SNathan Whitehorn case CMD_WRITE_RTC:
4813df9e037SNathan Whitehorn break;
4823df9e037SNathan Whitehorn }
483582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
484582434bdSNathan Whitehorn break;
485582434bdSNathan Whitehorn case CUDA_ERROR:
486582434bdSNathan Whitehorn /*
487582434bdSNathan Whitehorn * CUDA will throw errors if we miss a race between
488582434bdSNathan Whitehorn * sending and receiving packets. This is already
489582434bdSNathan Whitehorn * handled when we abort packet output to handle
490582434bdSNathan Whitehorn * this packet in cuda_intr(). Thus, we ignore
491582434bdSNathan Whitehorn * these messages.
492582434bdSNathan Whitehorn */
493582434bdSNathan Whitehorn break;
494582434bdSNathan Whitehorn default:
495582434bdSNathan Whitehorn device_printf(dev,"unknown CUDA command %d\n",
496582434bdSNathan Whitehorn pkt->type);
497582434bdSNathan Whitehorn break;
498582434bdSNathan Whitehorn }
499582434bdSNathan Whitehorn
500582434bdSNathan Whitehorn mtx_lock(&sc->sc_mutex);
501011ad8e7SNathan Whitehorn
502011ad8e7SNathan Whitehorn STAILQ_INSERT_TAIL(&sc->sc_freeq, pkt, pkt_q);
503582434bdSNathan Whitehorn }
504582434bdSNathan Whitehorn
505582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
506b4dbc599SNathan Whitehorn }
507b4dbc599SNathan Whitehorn
50865f44679SAndriy Gapon static u_int
cuda_poll(device_t dev)509b4dbc599SNathan Whitehorn cuda_poll(device_t dev)
510b4dbc599SNathan Whitehorn {
511b4dbc599SNathan Whitehorn struct cuda_softc *sc = device_get_softc(dev);
512b4dbc599SNathan Whitehorn
51301418697SNathan Whitehorn if (sc->sc_state == CUDA_IDLE && !cuda_intr_state(sc) &&
51401418697SNathan Whitehorn !sc->sc_waiting)
51565f44679SAndriy Gapon return (0);
51601418697SNathan Whitehorn
517b4dbc599SNathan Whitehorn cuda_intr(dev);
51865f44679SAndriy Gapon return (0);
519b4dbc599SNathan Whitehorn }
520b4dbc599SNathan Whitehorn
521b4dbc599SNathan Whitehorn static void
cuda_intr(void * arg)522b4dbc599SNathan Whitehorn cuda_intr(void *arg)
523b4dbc599SNathan Whitehorn {
524b4dbc599SNathan Whitehorn device_t dev;
525b4dbc599SNathan Whitehorn struct cuda_softc *sc;
5269c861e93SJohn Baldwin int ending, process_inbound;
527b4dbc599SNathan Whitehorn uint8_t reg;
528b4dbc599SNathan Whitehorn
529b4dbc599SNathan Whitehorn dev = (device_t)arg;
530b4dbc599SNathan Whitehorn sc = device_get_softc(dev);
531b4dbc599SNathan Whitehorn
532b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mutex);
533b4dbc599SNathan Whitehorn
534582434bdSNathan Whitehorn process_inbound = 0;
535b4dbc599SNathan Whitehorn reg = cuda_read_reg(sc, vIFR);
536582434bdSNathan Whitehorn if ((reg & vSR_INT) != vSR_INT) {
537582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
538582434bdSNathan Whitehorn return;
539582434bdSNathan Whitehorn }
540582434bdSNathan Whitehorn
541b4dbc599SNathan Whitehorn cuda_write_reg(sc, vIFR, 0x7f); /* Clear interrupt */
542b4dbc599SNathan Whitehorn
543b4dbc599SNathan Whitehorn switch_start:
544b4dbc599SNathan Whitehorn switch (sc->sc_state) {
545b4dbc599SNathan Whitehorn case CUDA_IDLE:
546b4dbc599SNathan Whitehorn /*
547b4dbc599SNathan Whitehorn * This is an unexpected packet, so grab the first (dummy)
548b4dbc599SNathan Whitehorn * byte, set up the proper vars, and tell the chip we are
549b4dbc599SNathan Whitehorn * starting to receive the packet by setting the TIP bit.
550b4dbc599SNathan Whitehorn */
551b4dbc599SNathan Whitehorn sc->sc_in[1] = cuda_read_reg(sc, vSR);
552b4dbc599SNathan Whitehorn
553b4dbc599SNathan Whitehorn if (cuda_intr_state(sc) == 0) {
554b4dbc599SNathan Whitehorn /* must have been a fake start */
555b4dbc599SNathan Whitehorn
556b4dbc599SNathan Whitehorn if (sc->sc_waiting) {
557b4dbc599SNathan Whitehorn /* start over */
558b4dbc599SNathan Whitehorn DELAY(150);
559b4dbc599SNathan Whitehorn sc->sc_state = CUDA_OUT;
560b4dbc599SNathan Whitehorn sc->sc_sent = 0;
561b4dbc599SNathan Whitehorn cuda_out(sc);
562b4dbc599SNathan Whitehorn cuda_write_reg(sc, vSR, sc->sc_out[1]);
563b4dbc599SNathan Whitehorn cuda_ack_off(sc);
564b4dbc599SNathan Whitehorn cuda_tip(sc);
565b4dbc599SNathan Whitehorn }
566b4dbc599SNathan Whitehorn break;
567b4dbc599SNathan Whitehorn }
568b4dbc599SNathan Whitehorn
569b4dbc599SNathan Whitehorn cuda_in(sc);
570b4dbc599SNathan Whitehorn cuda_tip(sc);
571b4dbc599SNathan Whitehorn
572b4dbc599SNathan Whitehorn sc->sc_received = 1;
573b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IN;
574b4dbc599SNathan Whitehorn break;
575b4dbc599SNathan Whitehorn
576b4dbc599SNathan Whitehorn case CUDA_IN:
577b4dbc599SNathan Whitehorn sc->sc_in[sc->sc_received] = cuda_read_reg(sc, vSR);
578b4dbc599SNathan Whitehorn ending = 0;
579b4dbc599SNathan Whitehorn
580b4dbc599SNathan Whitehorn if (sc->sc_received > 255) {
581b4dbc599SNathan Whitehorn /* bitch only once */
582b4dbc599SNathan Whitehorn if (sc->sc_received == 256) {
583b4dbc599SNathan Whitehorn device_printf(dev,"input overflow\n");
584b4dbc599SNathan Whitehorn ending = 1;
585b4dbc599SNathan Whitehorn }
586b4dbc599SNathan Whitehorn } else
587b4dbc599SNathan Whitehorn sc->sc_received++;
588b4dbc599SNathan Whitehorn
589b4dbc599SNathan Whitehorn /* intr off means this is the last byte (end of frame) */
590b4dbc599SNathan Whitehorn if (cuda_intr_state(sc) == 0) {
591b4dbc599SNathan Whitehorn ending = 1;
592b4dbc599SNathan Whitehorn } else {
593b4dbc599SNathan Whitehorn cuda_toggle_ack(sc);
594b4dbc599SNathan Whitehorn }
595b4dbc599SNathan Whitehorn
596b4dbc599SNathan Whitehorn if (ending == 1) { /* end of message? */
597582434bdSNathan Whitehorn struct cuda_packet *pkt;
598b4dbc599SNathan Whitehorn
599b4dbc599SNathan Whitehorn /* reset vars and signal the end of this frame */
600b4dbc599SNathan Whitehorn cuda_idle(sc);
601b4dbc599SNathan Whitehorn
602582434bdSNathan Whitehorn /* Queue up the packet */
603011ad8e7SNathan Whitehorn pkt = STAILQ_FIRST(&sc->sc_freeq);
604011ad8e7SNathan Whitehorn if (pkt != NULL) {
605011ad8e7SNathan Whitehorn /* If we have a free packet, process it */
606b4dbc599SNathan Whitehorn
607582434bdSNathan Whitehorn pkt->len = sc->sc_received - 2;
608582434bdSNathan Whitehorn pkt->type = sc->sc_in[1];
609582434bdSNathan Whitehorn memcpy(pkt->data, &sc->sc_in[2], pkt->len);
610582434bdSNathan Whitehorn
611011ad8e7SNathan Whitehorn STAILQ_REMOVE_HEAD(&sc->sc_freeq, pkt_q);
612582434bdSNathan Whitehorn STAILQ_INSERT_TAIL(&sc->sc_inq, pkt, pkt_q);
613b4dbc599SNathan Whitehorn
614011ad8e7SNathan Whitehorn process_inbound = 1;
615011ad8e7SNathan Whitehorn }
616011ad8e7SNathan Whitehorn
617b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IDLE;
618b4dbc599SNathan Whitehorn sc->sc_received = 0;
619b4dbc599SNathan Whitehorn
620b4dbc599SNathan Whitehorn /*
621b4dbc599SNathan Whitehorn * If there is something waiting to be sent out,
622b4dbc599SNathan Whitehorn * set everything up and send the first byte.
623b4dbc599SNathan Whitehorn */
624b4dbc599SNathan Whitehorn if (sc->sc_waiting == 1) {
625b4dbc599SNathan Whitehorn DELAY(1500); /* required */
626b4dbc599SNathan Whitehorn sc->sc_sent = 0;
627b4dbc599SNathan Whitehorn sc->sc_state = CUDA_OUT;
628b4dbc599SNathan Whitehorn
629b4dbc599SNathan Whitehorn /*
630b4dbc599SNathan Whitehorn * If the interrupt is on, we were too slow
631b4dbc599SNathan Whitehorn * and the chip has already started to send
632b4dbc599SNathan Whitehorn * something to us, so back out of the write
633b4dbc599SNathan Whitehorn * and start a read cycle.
634b4dbc599SNathan Whitehorn */
635b4dbc599SNathan Whitehorn if (cuda_intr_state(sc)) {
636b4dbc599SNathan Whitehorn cuda_in(sc);
637b4dbc599SNathan Whitehorn cuda_idle(sc);
638b4dbc599SNathan Whitehorn sc->sc_sent = 0;
639b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IDLE;
640b4dbc599SNathan Whitehorn sc->sc_received = 0;
641b4dbc599SNathan Whitehorn DELAY(150);
642b4dbc599SNathan Whitehorn goto switch_start;
643b4dbc599SNathan Whitehorn }
644582434bdSNathan Whitehorn
645b4dbc599SNathan Whitehorn /*
646b4dbc599SNathan Whitehorn * If we got here, it's ok to start sending
647b4dbc599SNathan Whitehorn * so load the first byte and tell the chip
648b4dbc599SNathan Whitehorn * we want to send.
649b4dbc599SNathan Whitehorn */
650b4dbc599SNathan Whitehorn cuda_out(sc);
651b4dbc599SNathan Whitehorn cuda_write_reg(sc, vSR,
652b4dbc599SNathan Whitehorn sc->sc_out[sc->sc_sent]);
653b4dbc599SNathan Whitehorn cuda_ack_off(sc);
654b4dbc599SNathan Whitehorn cuda_tip(sc);
655b4dbc599SNathan Whitehorn }
656b4dbc599SNathan Whitehorn }
657b4dbc599SNathan Whitehorn break;
658b4dbc599SNathan Whitehorn
659b4dbc599SNathan Whitehorn case CUDA_OUT:
6609c861e93SJohn Baldwin cuda_read_reg(sc, vSR); /* reset SR-intr in IFR */
661b4dbc599SNathan Whitehorn
662b4dbc599SNathan Whitehorn sc->sc_sent++;
663b4dbc599SNathan Whitehorn if (cuda_intr_state(sc)) { /* ADB intr low during write */
664b4dbc599SNathan Whitehorn cuda_in(sc); /* make sure SR is set to IN */
665b4dbc599SNathan Whitehorn cuda_idle(sc);
666b4dbc599SNathan Whitehorn sc->sc_sent = 0; /* must start all over */
667b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IDLE; /* new state */
668b4dbc599SNathan Whitehorn sc->sc_received = 0;
669b4dbc599SNathan Whitehorn sc->sc_waiting = 1; /* must retry when done with
670b4dbc599SNathan Whitehorn * read */
671b4dbc599SNathan Whitehorn DELAY(150);
672b4dbc599SNathan Whitehorn goto switch_start; /* process next state right
673b4dbc599SNathan Whitehorn * now */
674b4dbc599SNathan Whitehorn break;
675b4dbc599SNathan Whitehorn }
676b4dbc599SNathan Whitehorn if (sc->sc_out_length == sc->sc_sent) { /* check for done */
677b4dbc599SNathan Whitehorn sc->sc_waiting = 0; /* done writing */
678b4dbc599SNathan Whitehorn sc->sc_state = CUDA_IDLE; /* signal bus is idle */
679b4dbc599SNathan Whitehorn cuda_in(sc);
680b4dbc599SNathan Whitehorn cuda_idle(sc);
681b4dbc599SNathan Whitehorn } else {
682b4dbc599SNathan Whitehorn /* send next byte */
683b4dbc599SNathan Whitehorn cuda_write_reg(sc, vSR, sc->sc_out[sc->sc_sent]);
684b4dbc599SNathan Whitehorn cuda_toggle_ack(sc); /* signal byte ready to
685b4dbc599SNathan Whitehorn * shift */
686b4dbc599SNathan Whitehorn }
687b4dbc599SNathan Whitehorn break;
688b4dbc599SNathan Whitehorn
689b4dbc599SNathan Whitehorn case CUDA_NOTREADY:
690b4dbc599SNathan Whitehorn break;
691b4dbc599SNathan Whitehorn
692b4dbc599SNathan Whitehorn default:
693b4dbc599SNathan Whitehorn break;
694b4dbc599SNathan Whitehorn }
695b4dbc599SNathan Whitehorn
696b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
697582434bdSNathan Whitehorn
698582434bdSNathan Whitehorn if (process_inbound)
699582434bdSNathan Whitehorn cuda_send_inbound(sc);
700582434bdSNathan Whitehorn
701582434bdSNathan Whitehorn mtx_lock(&sc->sc_mutex);
702582434bdSNathan Whitehorn /* If we have another packet waiting, set it up */
703582434bdSNathan Whitehorn if (!sc->sc_waiting && sc->sc_state == CUDA_IDLE)
704582434bdSNathan Whitehorn cuda_send_outbound(sc);
705582434bdSNathan Whitehorn
706582434bdSNathan Whitehorn mtx_unlock(&sc->sc_mutex);
707582434bdSNathan Whitehorn
708b4dbc599SNathan Whitehorn }
709b4dbc599SNathan Whitehorn
710b4dbc599SNathan Whitehorn static u_int
cuda_adb_send(device_t dev,u_char command_byte,int len,u_char * data,u_char poll)711582434bdSNathan Whitehorn cuda_adb_send(device_t dev, u_char command_byte, int len, u_char *data,
712582434bdSNathan Whitehorn u_char poll)
713b4dbc599SNathan Whitehorn {
714b4dbc599SNathan Whitehorn struct cuda_softc *sc = device_get_softc(dev);
715b4dbc599SNathan Whitehorn uint8_t packet[16];
716582434bdSNathan Whitehorn int i;
717b4dbc599SNathan Whitehorn
718b4dbc599SNathan Whitehorn /* construct an ADB command packet and send it */
719b4dbc599SNathan Whitehorn packet[0] = CUDA_ADB;
720b4dbc599SNathan Whitehorn packet[1] = command_byte;
721b4dbc599SNathan Whitehorn for (i = 0; i < len; i++)
722b4dbc599SNathan Whitehorn packet[i + 2] = data[i];
723b4dbc599SNathan Whitehorn
724b4dbc599SNathan Whitehorn cuda_send(sc, poll, len + 2, packet);
725b4dbc599SNathan Whitehorn
726582434bdSNathan Whitehorn return (0);
727b4dbc599SNathan Whitehorn }
728b4dbc599SNathan Whitehorn
729b4dbc599SNathan Whitehorn static u_int
cuda_adb_autopoll(device_t dev,uint16_t mask)730b4dbc599SNathan Whitehorn cuda_adb_autopoll(device_t dev, uint16_t mask) {
731b4dbc599SNathan Whitehorn struct cuda_softc *sc = device_get_softc(dev);
732b4dbc599SNathan Whitehorn
733b4dbc599SNathan Whitehorn uint8_t cmd[] = {CUDA_PSEUDO, CMD_AUTOPOLL, mask != 0};
734b4dbc599SNathan Whitehorn
735b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mutex);
73601418697SNathan Whitehorn
737b4dbc599SNathan Whitehorn if (cmd[2] == sc->sc_autopoll) {
738b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
739582434bdSNathan Whitehorn return (0);
740b4dbc599SNathan Whitehorn }
741b4dbc599SNathan Whitehorn
742b4dbc599SNathan Whitehorn sc->sc_autopoll = -1;
743582434bdSNathan Whitehorn cuda_send(sc, 1, 3, cmd);
744b4dbc599SNathan Whitehorn
745b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
746b4dbc599SNathan Whitehorn
747582434bdSNathan Whitehorn return (0);
748b4dbc599SNathan Whitehorn }
749b4dbc599SNathan Whitehorn
750b2a237beSNathan Whitehorn static void
cuda_shutdown(void * xsc,int howto)751b2a237beSNathan Whitehorn cuda_shutdown(void *xsc, int howto)
752b2a237beSNathan Whitehorn {
753b2a237beSNathan Whitehorn struct cuda_softc *sc = xsc;
754b2a237beSNathan Whitehorn uint8_t cmd[] = {CUDA_PSEUDO, 0};
755b2a237beSNathan Whitehorn
75641e26e82SMitchell Horne if ((howto & RB_POWEROFF) != 0)
75741e26e82SMitchell Horne cmd[1] = CMD_POWEROFF;
75841e26e82SMitchell Horne else if ((howto & RB_HALT) == 0)
75941e26e82SMitchell Horne cmd[1] = CMD_RESET;
76041e26e82SMitchell Horne else
76141e26e82SMitchell Horne return;
76241e26e82SMitchell Horne
763b2a237beSNathan Whitehorn cuda_poll(sc->sc_dev);
764b2a237beSNathan Whitehorn cuda_send(sc, 1, 2, cmd);
765b2a237beSNathan Whitehorn
766b2a237beSNathan Whitehorn while (1)
767b2a237beSNathan Whitehorn cuda_poll(sc->sc_dev);
768b2a237beSNathan Whitehorn }
769b2a237beSNathan Whitehorn
7703df9e037SNathan Whitehorn #define DIFF19041970 2082844800
7713df9e037SNathan Whitehorn
7723df9e037SNathan Whitehorn static int
cuda_gettime(device_t dev,struct timespec * ts)7733df9e037SNathan Whitehorn cuda_gettime(device_t dev, struct timespec *ts)
7743df9e037SNathan Whitehorn {
7753df9e037SNathan Whitehorn struct cuda_softc *sc = device_get_softc(dev);
7763df9e037SNathan Whitehorn uint8_t cmd[] = {CUDA_PSEUDO, CMD_READ_RTC};
7773df9e037SNathan Whitehorn
7783df9e037SNathan Whitehorn mtx_lock(&sc->sc_mutex);
7793df9e037SNathan Whitehorn sc->sc_rtc = -1;
7803df9e037SNathan Whitehorn cuda_send(sc, 1, 2, cmd);
7813df9e037SNathan Whitehorn if (sc->sc_rtc == -1)
7823df9e037SNathan Whitehorn mtx_sleep(&sc->sc_rtc, &sc->sc_mutex, 0, "rtc", 100);
7833df9e037SNathan Whitehorn
7843df9e037SNathan Whitehorn ts->tv_sec = sc->sc_rtc - DIFF19041970;
7853df9e037SNathan Whitehorn ts->tv_nsec = 0;
7863df9e037SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
7873df9e037SNathan Whitehorn
7883df9e037SNathan Whitehorn return (0);
7893df9e037SNathan Whitehorn }
7903df9e037SNathan Whitehorn
7913df9e037SNathan Whitehorn static int
cuda_settime(device_t dev,struct timespec * ts)7923df9e037SNathan Whitehorn cuda_settime(device_t dev, struct timespec *ts)
7933df9e037SNathan Whitehorn {
7943df9e037SNathan Whitehorn struct cuda_softc *sc = device_get_softc(dev);
7953df9e037SNathan Whitehorn uint8_t cmd[] = {CUDA_PSEUDO, CMD_WRITE_RTC, 0, 0, 0, 0};
7963df9e037SNathan Whitehorn uint32_t sec;
7973df9e037SNathan Whitehorn
7983df9e037SNathan Whitehorn sec = ts->tv_sec + DIFF19041970;
7993df9e037SNathan Whitehorn memcpy(&cmd[2], &sec, sizeof(sec));
8003df9e037SNathan Whitehorn
8013df9e037SNathan Whitehorn mtx_lock(&sc->sc_mutex);
8023df9e037SNathan Whitehorn cuda_send(sc, 0, 6, cmd);
8033df9e037SNathan Whitehorn mtx_unlock(&sc->sc_mutex);
8043df9e037SNathan Whitehorn
8053df9e037SNathan Whitehorn return (0);
8063df9e037SNathan Whitehorn }
807