utoppy.c revision 1.22 1 1.22 skrll /* $NetBSD: utoppy.c,v 1.22 2013/08/30 12:59:19 skrll Exp $ */
2 1.1 scw
3 1.1 scw /*-
4 1.1 scw * Copyright (c) 2006 The NetBSD Foundation, Inc.
5 1.1 scw * All rights reserved.
6 1.1 scw *
7 1.1 scw * This code is derived from software contributed to The NetBSD Foundation
8 1.1 scw * by Steve C. Woodford.
9 1.1 scw *
10 1.1 scw * Redistribution and use in source and binary forms, with or without
11 1.1 scw * modification, are permitted provided that the following conditions
12 1.1 scw * are met:
13 1.1 scw * 1. Redistributions of source code must retain the above copyright
14 1.1 scw * notice, this list of conditions and the following disclaimer.
15 1.1 scw * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 scw * notice, this list of conditions and the following disclaimer in the
17 1.1 scw * documentation and/or other materials provided with the distribution.
18 1.1 scw *
19 1.1 scw * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 scw * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 scw * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 scw * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 scw * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 scw * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 scw * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 scw * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 scw * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 scw * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 scw * POSSIBILITY OF SUCH DAMAGE.
30 1.1 scw */
31 1.1 scw
32 1.1 scw #include <sys/cdefs.h>
33 1.22 skrll __KERNEL_RCSID(0, "$NetBSD: utoppy.c,v 1.22 2013/08/30 12:59:19 skrll Exp $");
34 1.1 scw
35 1.1 scw #include <sys/param.h>
36 1.1 scw #include <sys/systm.h>
37 1.1 scw #include <sys/proc.h>
38 1.1 scw #include <sys/kernel.h>
39 1.1 scw #include <sys/fcntl.h>
40 1.1 scw #include <sys/device.h>
41 1.1 scw #include <sys/malloc.h>
42 1.1 scw #include <sys/ioctl.h>
43 1.1 scw #include <sys/uio.h>
44 1.1 scw #include <sys/conf.h>
45 1.1 scw #include <sys/vnode.h>
46 1.19 mrg #include <sys/bus.h>
47 1.1 scw
48 1.1 scw #include <dev/usb/usb.h>
49 1.1 scw #include <dev/usb/usbdi.h>
50 1.19 mrg #include <dev/usb/usbdivar.h>
51 1.1 scw #include <dev/usb/usbdi_util.h>
52 1.1 scw #include <dev/usb/usbdevs.h>
53 1.1 scw #include <dev/usb/usb_quirks.h>
54 1.1 scw #include <dev/usb/utoppy.h>
55 1.1 scw
56 1.1 scw #undef UTOPPY_DEBUG
57 1.1 scw #ifdef UTOPPY_DEBUG
58 1.1 scw #define UTOPPY_DBG_OPEN 0x0001
59 1.1 scw #define UTOPPY_DBG_CLOSE 0x0002
60 1.1 scw #define UTOPPY_DBG_READ 0x0004
61 1.1 scw #define UTOPPY_DBG_WRITE 0x0008
62 1.1 scw #define UTOPPY_DBG_IOCTL 0x0010
63 1.1 scw #define UTOPPY_DBG_SEND_PACKET 0x0020
64 1.1 scw #define UTOPPY_DBG_RECV_PACKET 0x0040
65 1.1 scw #define UTOPPY_DBG_ADDPATH 0x0080
66 1.1 scw #define UTOPPY_DBG_READDIR 0x0100
67 1.1 scw #define UTOPPY_DBG_DUMP 0x0200
68 1.1 scw #define DPRINTF(l, m) \
69 1.1 scw do { \
70 1.1 scw if (utoppy_debug & l) \
71 1.1 scw printf m; \
72 1.1 scw } while (/*CONSTCOND*/0)
73 1.1 scw static int utoppy_debug = 0;
74 1.1 scw static void utoppy_dump_packet(const void *, size_t);
75 1.1 scw #define DDUMP_PACKET(p, l) \
76 1.1 scw do { \
77 1.1 scw if (utoppy_debug & UTOPPY_DBG_DUMP) \
78 1.1 scw utoppy_dump_packet((p), (l)); \
79 1.1 scw } while (/*CONSTCOND*/0)
80 1.1 scw #else
81 1.1 scw #define DPRINTF(l, m) /* nothing */
82 1.1 scw #define DDUMP_PACKET(p, l) /* nothing */
83 1.1 scw #endif
84 1.1 scw
85 1.1 scw
86 1.1 scw #define UTOPPY_CONFIG_NO 1
87 1.1 scw #define UTOPPY_NUMENDPOINTS 2
88 1.1 scw
89 1.1 scw #define UTOPPY_BSIZE 0xffff
90 1.1 scw #define UTOPPY_FRAG_SIZE 0x1000
91 1.1 scw #define UTOPPY_HEADER_SIZE 8
92 1.1 scw #define UTOPPY_SHORT_TIMEOUT (500) /* 0.5 seconds */
93 1.1 scw #define UTOPPY_LONG_TIMEOUT (10 * 1000) /* 10 seconds */
94 1.1 scw
95 1.1 scw /* Protocol Commands and Responses */
96 1.1 scw #define UTOPPY_RESP_ERROR 0x0001
97 1.1 scw #define UTOPPY_CMD_ACK 0x0002
98 1.1 scw #define UTOPPY_RESP_SUCCESS UTOPPY_CMD_ACK
99 1.1 scw #define UTOPPY_CMD_CANCEL 0x0003
100 1.1 scw #define UTOPPY_CMD_READY 0x0100
101 1.1 scw #define UTOPPY_CMD_RESET 0x0101
102 1.1 scw #define UTOPPY_CMD_TURBO 0x0102
103 1.1 scw #define UTOPPY_CMD_STATS 0x1000
104 1.1 scw #define UTOPPY_RESP_STATS_DATA 0x1001
105 1.1 scw #define UTOPPY_CMD_READDIR 0x1002
106 1.1 scw #define UTOPPY_RESP_READDIR_DATA 0x1003
107 1.1 scw #define UTOPPY_RESP_READDIR_END 0x1004
108 1.1 scw #define UTOPPY_CMD_DELETE 0x1005
109 1.1 scw #define UTOPPY_CMD_RENAME 0x1006
110 1.1 scw #define UTOPPY_CMD_MKDIR 0x1007
111 1.1 scw #define UTOPPY_CMD_FILE 0x1008
112 1.1 scw #define UTOPPY_FILE_WRITE 0
113 1.1 scw #define UTOPPY_FILE_READ 1
114 1.1 scw #define UTOPPY_RESP_FILE_HEADER 0x1009
115 1.1 scw #define UTOPPY_RESP_FILE_DATA 0x100a
116 1.1 scw #define UTOPPY_RESP_FILE_END 0x100b
117 1.1 scw
118 1.1 scw enum utoppy_state {
119 1.1 scw UTOPPY_STATE_CLOSED,
120 1.1 scw UTOPPY_STATE_OPENING,
121 1.1 scw UTOPPY_STATE_IDLE,
122 1.1 scw UTOPPY_STATE_READDIR,
123 1.1 scw UTOPPY_STATE_READFILE,
124 1.1 scw UTOPPY_STATE_WRITEFILE
125 1.1 scw };
126 1.1 scw
127 1.1 scw struct utoppy_softc {
128 1.15 dyoung device_t sc_dev;
129 1.1 scw usbd_device_handle sc_udev; /* device */
130 1.1 scw usbd_interface_handle sc_iface; /* interface */
131 1.1 scw int sc_dying;
132 1.1 scw int sc_refcnt;
133 1.1 scw
134 1.1 scw enum utoppy_state sc_state;
135 1.1 scw u_int sc_turbo_mode;
136 1.1 scw
137 1.1 scw int sc_out;
138 1.1 scw usbd_pipe_handle sc_out_pipe; /* bulk out pipe */
139 1.1 scw usbd_xfer_handle sc_out_xfer;
140 1.1 scw void *sc_out_buf;
141 1.1 scw void *sc_out_data;
142 1.1 scw uint64_t sc_wr_offset;
143 1.1 scw uint64_t sc_wr_size;
144 1.1 scw
145 1.1 scw int sc_in;
146 1.1 scw usbd_pipe_handle sc_in_pipe; /* bulk in pipe */
147 1.1 scw usbd_xfer_handle sc_in_xfer;
148 1.1 scw void *sc_in_buf;
149 1.1 scw void *sc_in_data;
150 1.1 scw size_t sc_in_len;
151 1.1 scw u_int sc_in_offset;
152 1.1 scw };
153 1.1 scw
154 1.1 scw struct utoppy_header {
155 1.1 scw uint16_t h_len;
156 1.1 scw uint16_t h_crc;
157 1.1 scw uint16_t h_cmd2;
158 1.1 scw uint16_t h_cmd;
159 1.1 scw uint8_t h_data[0];
160 1.1 scw };
161 1.1 scw #define UTOPPY_OUT_INIT(sc) \
162 1.1 scw do { \
163 1.1 scw struct utoppy_header *_h = sc->sc_out_data; \
164 1.1 scw _h->h_len = 0; \
165 1.1 scw } while (/*CONSTCOND*/0)
166 1.1 scw
167 1.1 scw #define UTOPPY_MJD_1970 40587u /* MJD value for Jan 1 00:00:00 1970 */
168 1.1 scw
169 1.1 scw #define UTOPPY_FTYPE_DIR 1
170 1.1 scw #define UTOPPY_FTYPE_FILE 2
171 1.1 scw
172 1.1 scw #define UTOPPY_IN_DATA(sc) \
173 1.1 scw ((void*)&(((uint8_t*)(sc)->sc_in_data)[(sc)->sc_in_offset+UTOPPY_HEADER_SIZE]))
174 1.1 scw
175 1.1 scw dev_type_open(utoppyopen);
176 1.1 scw dev_type_close(utoppyclose);
177 1.1 scw dev_type_read(utoppyread);
178 1.1 scw dev_type_write(utoppywrite);
179 1.1 scw dev_type_ioctl(utoppyioctl);
180 1.1 scw
181 1.1 scw const struct cdevsw utoppy_cdevsw = {
182 1.1 scw utoppyopen, utoppyclose, utoppyread, utoppywrite, utoppyioctl,
183 1.6 christos nostop, notty, nopoll, nommap, nokqfilter, D_OTHER,
184 1.1 scw };
185 1.1 scw
186 1.1 scw #define UTOPPYUNIT(n) (minor(n))
187 1.1 scw
188 1.15 dyoung int utoppy_match(device_t, cfdata_t, void *);
189 1.15 dyoung void utoppy_attach(device_t, device_t, void *);
190 1.15 dyoung int utoppy_detach(device_t, int);
191 1.15 dyoung int utoppy_activate(device_t, enum devact);
192 1.15 dyoung extern struct cfdriver utoppy_cd;
193 1.15 dyoung CFATTACH_DECL_NEW(utoppy, sizeof(struct utoppy_softc), utoppy_match, utoppy_attach, utoppy_detach, utoppy_activate);
194 1.1 scw
195 1.17 jakllsch int
196 1.15 dyoung utoppy_match(device_t parent, cfdata_t match, void *aux)
197 1.1 scw {
198 1.15 dyoung struct usb_attach_arg *uaa = aux;
199 1.1 scw
200 1.1 scw if (uaa->vendor == USB_VENDOR_TOPFIELD &&
201 1.1 scw uaa->product == USB_PRODUCT_TOPFIELD_TF5000PVR)
202 1.1 scw return (UMATCH_VENDOR_PRODUCT);
203 1.1 scw
204 1.1 scw return (UMATCH_NONE);
205 1.1 scw }
206 1.1 scw
207 1.17 jakllsch void
208 1.15 dyoung utoppy_attach(device_t parent, device_t self, void *aux)
209 1.1 scw {
210 1.15 dyoung struct utoppy_softc *sc = device_private(self);
211 1.15 dyoung struct usb_attach_arg *uaa = aux;
212 1.1 scw usbd_device_handle dev = uaa->device;
213 1.10 drochner usbd_interface_handle iface;
214 1.1 scw usb_endpoint_descriptor_t *ed;
215 1.1 scw char *devinfop;
216 1.1 scw u_int8_t epcount;
217 1.1 scw int i;
218 1.1 scw
219 1.12 cube sc->sc_dev = self;
220 1.12 cube
221 1.13 plunky aprint_naive("\n");
222 1.13 plunky aprint_normal("\n");
223 1.13 plunky
224 1.1 scw devinfop = usbd_devinfo_alloc(dev, 0);
225 1.12 cube aprint_normal_dev(self, "%s\n", devinfop);
226 1.1 scw usbd_devinfo_free(devinfop);
227 1.1 scw
228 1.1 scw sc->sc_dying = 0;
229 1.1 scw sc->sc_refcnt = 0;
230 1.1 scw sc->sc_udev = dev;
231 1.1 scw
232 1.10 drochner if (usbd_set_config_index(dev, 0, 1)
233 1.10 drochner || usbd_device2interface_handle(dev, 0, &iface)) {
234 1.12 cube aprint_error_dev(self, "Configuration failed\n");
235 1.15 dyoung return;
236 1.10 drochner }
237 1.10 drochner
238 1.1 scw epcount = 0;
239 1.10 drochner (void) usbd_endpoint_count(iface, &epcount);
240 1.1 scw if (epcount != UTOPPY_NUMENDPOINTS) {
241 1.12 cube aprint_error_dev(self, "Expected %d endpoints, got %d\n",
242 1.12 cube UTOPPY_NUMENDPOINTS, epcount);
243 1.15 dyoung return;
244 1.1 scw }
245 1.1 scw
246 1.1 scw sc->sc_in = -1;
247 1.1 scw sc->sc_out = -1;
248 1.1 scw
249 1.1 scw for (i = 0; i < epcount; i++) {
250 1.10 drochner ed = usbd_interface2endpoint_descriptor(iface, i);
251 1.1 scw if (ed == NULL) {
252 1.12 cube aprint_error_dev(self, "couldn't get ep %d\n", i);
253 1.15 dyoung return;
254 1.1 scw }
255 1.1 scw
256 1.1 scw if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
257 1.1 scw UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
258 1.1 scw sc->sc_in = ed->bEndpointAddress;
259 1.1 scw } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
260 1.1 scw UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
261 1.1 scw sc->sc_out = ed->bEndpointAddress;
262 1.1 scw }
263 1.1 scw }
264 1.1 scw
265 1.1 scw if (sc->sc_out == -1 || sc->sc_in == -1) {
266 1.12 cube aprint_error_dev(self,
267 1.12 cube "could not find bulk in/out endpoints\n");
268 1.1 scw sc->sc_dying = 1;
269 1.15 dyoung return;
270 1.1 scw }
271 1.1 scw
272 1.10 drochner sc->sc_iface = iface;
273 1.1 scw sc->sc_udev = dev;
274 1.1 scw
275 1.1 scw sc->sc_out_xfer = usbd_alloc_xfer(sc->sc_udev);
276 1.1 scw if (sc->sc_out_xfer == NULL) {
277 1.12 cube aprint_error_dev(self, "could not allocate bulk out xfer\n");
278 1.1 scw goto fail0;
279 1.1 scw }
280 1.1 scw
281 1.1 scw sc->sc_out_buf = usbd_alloc_buffer(sc->sc_out_xfer, UTOPPY_FRAG_SIZE);
282 1.1 scw if (sc->sc_out_buf == NULL) {
283 1.12 cube aprint_error_dev(self, "could not allocate bulk out buffer\n");
284 1.1 scw goto fail1;
285 1.1 scw }
286 1.1 scw
287 1.1 scw sc->sc_in_xfer = usbd_alloc_xfer(sc->sc_udev);
288 1.1 scw if (sc->sc_in_xfer == NULL) {
289 1.12 cube aprint_error_dev(self, "could not allocate bulk in xfer\n");
290 1.1 scw goto fail1;
291 1.1 scw }
292 1.1 scw
293 1.1 scw sc->sc_in_buf = usbd_alloc_buffer(sc->sc_in_xfer, UTOPPY_FRAG_SIZE);
294 1.1 scw if (sc->sc_in_buf == NULL) {
295 1.12 cube aprint_error_dev(self, "could not allocate bulk in buffer\n");
296 1.1 scw goto fail2;
297 1.1 scw }
298 1.1 scw
299 1.1 scw usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
300 1.15 dyoung sc->sc_dev);
301 1.1 scw
302 1.15 dyoung return;
303 1.1 scw
304 1.1 scw fail2: usbd_free_xfer(sc->sc_in_xfer);
305 1.1 scw sc->sc_in_xfer = NULL;
306 1.1 scw
307 1.1 scw fail1: usbd_free_xfer(sc->sc_out_xfer);
308 1.1 scw sc->sc_out_xfer = NULL;
309 1.1 scw
310 1.1 scw fail0: sc->sc_dying = 1;
311 1.15 dyoung return;
312 1.1 scw }
313 1.1 scw
314 1.1 scw int
315 1.15 dyoung utoppy_activate(device_t self, enum devact act)
316 1.1 scw {
317 1.12 cube struct utoppy_softc *sc = device_private(self);
318 1.1 scw
319 1.1 scw switch (act) {
320 1.1 scw case DVACT_DEACTIVATE:
321 1.1 scw sc->sc_dying = 1;
322 1.14 dyoung return 0;
323 1.14 dyoung default:
324 1.14 dyoung return EOPNOTSUPP;
325 1.1 scw }
326 1.1 scw }
327 1.1 scw
328 1.17 jakllsch int
329 1.15 dyoung utoppy_detach(device_t self, int flags)
330 1.1 scw {
331 1.15 dyoung struct utoppy_softc *sc = device_private(self);
332 1.1 scw int maj, mn;
333 1.1 scw int s;
334 1.1 scw
335 1.1 scw sc->sc_dying = 1;
336 1.1 scw if (sc->sc_out_pipe != NULL)
337 1.1 scw usbd_abort_pipe(sc->sc_out_pipe);
338 1.1 scw if (sc->sc_in_pipe != NULL)
339 1.1 scw usbd_abort_pipe(sc->sc_in_pipe);
340 1.1 scw
341 1.1 scw if (sc->sc_in_xfer != NULL)
342 1.1 scw usbd_free_xfer(sc->sc_in_xfer);
343 1.1 scw if (sc->sc_out_xfer != NULL)
344 1.1 scw usbd_free_xfer(sc->sc_out_xfer);
345 1.1 scw
346 1.1 scw s = splusb();
347 1.1 scw if (--sc->sc_refcnt >= 0)
348 1.18 mrg usb_detach_waitold(sc->sc_dev);
349 1.1 scw splx(s);
350 1.1 scw
351 1.1 scw /* locate the major number */
352 1.1 scw maj = cdevsw_lookup_major(&utoppy_cdevsw);
353 1.1 scw
354 1.1 scw /* Nuke the vnodes for any open instances (calls close). */
355 1.21 chs mn = device_unit(self);
356 1.1 scw vdevgone(maj, mn, mn, VCHR);
357 1.1 scw
358 1.1 scw usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
359 1.15 dyoung sc->sc_dev);
360 1.1 scw
361 1.1 scw return (0);
362 1.1 scw }
363 1.1 scw
364 1.1 scw static const uint16_t utoppy_crc16_lookup[] = {
365 1.1 scw 0x0000, 0xc0c1, 0xc181, 0x0140, 0xc301, 0x03c0, 0x0280, 0xc241,
366 1.1 scw 0xc601, 0x06c0, 0x0780, 0xc741, 0x0500, 0xc5c1, 0xc481, 0x0440,
367 1.1 scw 0xcc01, 0x0cc0, 0x0d80, 0xcd41, 0x0f00, 0xcfc1, 0xce81, 0x0e40,
368 1.1 scw 0x0a00, 0xcac1, 0xcb81, 0x0b40, 0xc901, 0x09c0, 0x0880, 0xc841,
369 1.1 scw 0xd801, 0x18c0, 0x1980, 0xd941, 0x1b00, 0xdbc1, 0xda81, 0x1a40,
370 1.1 scw 0x1e00, 0xdec1, 0xdf81, 0x1f40, 0xdd01, 0x1dc0, 0x1c80, 0xdc41,
371 1.1 scw 0x1400, 0xd4c1, 0xd581, 0x1540, 0xd701, 0x17c0, 0x1680, 0xd641,
372 1.1 scw 0xd201, 0x12c0, 0x1380, 0xd341, 0x1100, 0xd1c1, 0xd081, 0x1040,
373 1.1 scw 0xf001, 0x30c0, 0x3180, 0xf141, 0x3300, 0xf3c1, 0xf281, 0x3240,
374 1.1 scw 0x3600, 0xf6c1, 0xf781, 0x3740, 0xf501, 0x35c0, 0x3480, 0xf441,
375 1.1 scw 0x3c00, 0xfcc1, 0xfd81, 0x3d40, 0xff01, 0x3fc0, 0x3e80, 0xfe41,
376 1.1 scw 0xfa01, 0x3ac0, 0x3b80, 0xfb41, 0x3900, 0xf9c1, 0xf881, 0x3840,
377 1.1 scw 0x2800, 0xe8c1, 0xe981, 0x2940, 0xeb01, 0x2bc0, 0x2a80, 0xea41,
378 1.1 scw 0xee01, 0x2ec0, 0x2f80, 0xef41, 0x2d00, 0xedc1, 0xec81, 0x2c40,
379 1.1 scw 0xe401, 0x24c0, 0x2580, 0xe541, 0x2700, 0xe7c1, 0xe681, 0x2640,
380 1.1 scw 0x2200, 0xe2c1, 0xe381, 0x2340, 0xe101, 0x21c0, 0x2080, 0xe041,
381 1.1 scw 0xa001, 0x60c0, 0x6180, 0xa141, 0x6300, 0xa3c1, 0xa281, 0x6240,
382 1.1 scw 0x6600, 0xa6c1, 0xa781, 0x6740, 0xa501, 0x65c0, 0x6480, 0xa441,
383 1.1 scw 0x6c00, 0xacc1, 0xad81, 0x6d40, 0xaf01, 0x6fc0, 0x6e80, 0xae41,
384 1.1 scw 0xaa01, 0x6ac0, 0x6b80, 0xab41, 0x6900, 0xa9c1, 0xa881, 0x6840,
385 1.1 scw 0x7800, 0xb8c1, 0xb981, 0x7940, 0xbb01, 0x7bc0, 0x7a80, 0xba41,
386 1.1 scw 0xbe01, 0x7ec0, 0x7f80, 0xbf41, 0x7d00, 0xbdc1, 0xbc81, 0x7c40,
387 1.1 scw 0xb401, 0x74c0, 0x7580, 0xb541, 0x7700, 0xb7c1, 0xb681, 0x7640,
388 1.1 scw 0x7200, 0xb2c1, 0xb381, 0x7340, 0xb101, 0x71c0, 0x7080, 0xb041,
389 1.1 scw 0x5000, 0x90c1, 0x9181, 0x5140, 0x9301, 0x53c0, 0x5280, 0x9241,
390 1.1 scw 0x9601, 0x56c0, 0x5780, 0x9741, 0x5500, 0x95c1, 0x9481, 0x5440,
391 1.1 scw 0x9c01, 0x5cc0, 0x5d80, 0x9d41, 0x5f00, 0x9fc1, 0x9e81, 0x5e40,
392 1.1 scw 0x5a00, 0x9ac1, 0x9b81, 0x5b40, 0x9901, 0x59c0, 0x5880, 0x9841,
393 1.1 scw 0x8801, 0x48c0, 0x4980, 0x8941, 0x4b00, 0x8bc1, 0x8a81, 0x4a40,
394 1.1 scw 0x4e00, 0x8ec1, 0x8f81, 0x4f40, 0x8d01, 0x4dc0, 0x4c80, 0x8c41,
395 1.1 scw 0x4400, 0x84c1, 0x8581, 0x4540, 0x8701, 0x47c0, 0x4680, 0x8641,
396 1.1 scw 0x8201, 0x42c0, 0x4380, 0x8341, 0x4100, 0x81c1, 0x8081, 0x4040
397 1.1 scw };
398 1.1 scw
399 1.1 scw #define UTOPPY_CRC16(ccrc,b) \
400 1.1 scw (utoppy_crc16_lookup[((ccrc) ^ (b)) & 0xffu] ^ ((ccrc) >> 8))
401 1.1 scw
402 1.1 scw static const int utoppy_usbdstatus_lookup[] = {
403 1.1 scw 0, /* USBD_NORMAL_COMPLETION */
404 1.1 scw EINPROGRESS, /* USBD_IN_PROGRESS */
405 1.1 scw EALREADY, /* USBD_PENDING_REQUESTS */
406 1.1 scw EAGAIN, /* USBD_NOT_STARTED */
407 1.1 scw EINVAL, /* USBD_INVAL */
408 1.1 scw ENOMEM, /* USBD_NOMEM */
409 1.1 scw ECONNRESET, /* USBD_CANCELLED */
410 1.1 scw EFAULT, /* USBD_BAD_ADDRESS */
411 1.1 scw EBUSY, /* USBD_IN_USE */
412 1.1 scw EADDRNOTAVAIL, /* USBD_NO_ADDR */
413 1.1 scw ENETDOWN, /* USBD_SET_ADDR_FAILED */
414 1.1 scw EIO, /* USBD_NO_POWER */
415 1.1 scw EMLINK, /* USBD_TOO_DEEP */
416 1.1 scw EIO, /* USBD_IOERROR */
417 1.1 scw ENXIO, /* USBD_NOT_CONFIGURED */
418 1.1 scw ETIMEDOUT, /* USBD_TIMEOUT */
419 1.1 scw EBADMSG, /* USBD_SHORT_XFER */
420 1.1 scw EHOSTDOWN, /* USBD_STALLED */
421 1.1 scw EINTR /* USBD_INTERRUPTED */
422 1.1 scw };
423 1.1 scw
424 1.1 scw static __inline int
425 1.1 scw utoppy_usbd_status2errno(usbd_status err)
426 1.1 scw {
427 1.1 scw
428 1.1 scw if (err >= USBD_ERROR_MAX)
429 1.1 scw return (EFAULT);
430 1.1 scw return (utoppy_usbdstatus_lookup[err]);
431 1.1 scw }
432 1.1 scw
433 1.1 scw #ifdef UTOPPY_DEBUG
434 1.1 scw static const char *
435 1.1 scw utoppy_state_string(enum utoppy_state state)
436 1.1 scw {
437 1.1 scw const char *str;
438 1.1 scw
439 1.1 scw switch (state) {
440 1.1 scw case UTOPPY_STATE_CLOSED:
441 1.1 scw str = "CLOSED";
442 1.1 scw break;
443 1.1 scw case UTOPPY_STATE_OPENING:
444 1.1 scw str = "OPENING";
445 1.1 scw break;
446 1.1 scw case UTOPPY_STATE_IDLE:
447 1.1 scw str = "IDLE";
448 1.1 scw break;
449 1.1 scw case UTOPPY_STATE_READDIR:
450 1.1 scw str = "READ DIRECTORY";
451 1.1 scw break;
452 1.1 scw case UTOPPY_STATE_READFILE:
453 1.1 scw str = "READ FILE";
454 1.1 scw break;
455 1.1 scw case UTOPPY_STATE_WRITEFILE:
456 1.1 scw str = "WRITE FILE";
457 1.1 scw break;
458 1.1 scw default:
459 1.1 scw str = "INVALID!";
460 1.1 scw break;
461 1.1 scw }
462 1.1 scw
463 1.1 scw return (str);
464 1.1 scw }
465 1.1 scw
466 1.1 scw static void
467 1.1 scw utoppy_dump_packet(const void *b, size_t len)
468 1.1 scw {
469 1.1 scw const uint8_t *buf = b, *l;
470 1.1 scw uint8_t c;
471 1.1 scw size_t i, j;
472 1.1 scw
473 1.1 scw if (len == 0)
474 1.1 scw return;
475 1.1 scw
476 1.1 scw len = min(len, 256);
477 1.1 scw
478 1.1 scw printf("00: ");
479 1.1 scw
480 1.1 scw for (i = 0, l = buf; i < len; i++) {
481 1.1 scw printf("%02x ", *buf++);
482 1.1 scw
483 1.1 scw if ((i % 16) == 15) {
484 1.1 scw for (j = 0; j < 16; j++) {
485 1.1 scw c = *l++;
486 1.1 scw if (c < ' ' || c > 0x7e)
487 1.1 scw c = '.';
488 1.1 scw printf("%c", c);
489 1.1 scw }
490 1.1 scw
491 1.1 scw printf("\n");
492 1.1 scw l = buf;
493 1.1 scw
494 1.1 scw if ((i + 1) < len)
495 1.1 scw printf("%02x: ", (u_int)i + 1);
496 1.1 scw }
497 1.1 scw }
498 1.1 scw
499 1.1 scw while ((i++ % 16) != 0)
500 1.1 scw printf(" ");
501 1.1 scw
502 1.1 scw if (l < buf) {
503 1.1 scw while (l < buf) {
504 1.1 scw c = *l++;
505 1.1 scw if (c < ' ' || c > 0x7e)
506 1.1 scw c = '.';
507 1.1 scw printf("%c", c);
508 1.1 scw }
509 1.1 scw
510 1.1 scw printf("\n");
511 1.1 scw }
512 1.1 scw }
513 1.1 scw #endif
514 1.1 scw
515 1.1 scw static usbd_status
516 1.1 scw utoppy_bulk_transfer(usbd_xfer_handle xfer, usbd_pipe_handle pipe,
517 1.1 scw u_int16_t flags, u_int32_t timeout, void *buf, u_int32_t *size,
518 1.1 scw const char *lbl)
519 1.1 scw {
520 1.1 scw usbd_status err;
521 1.1 scw
522 1.22 skrll usbd_setup_xfer(xfer, pipe, 0, buf, *size, flags, timeout, NULL);
523 1.22 skrll
524 1.22 skrll err = usbd_sync_transfer_sig(xfer);
525 1.22 skrll
526 1.22 skrll usbd_get_xfer_status(xfer, NULL, NULL, size, NULL);
527 1.1 scw return (err);
528 1.1 scw }
529 1.1 scw
530 1.1 scw static int
531 1.1 scw utoppy_send_packet(struct utoppy_softc *sc, uint16_t cmd, uint32_t timeout)
532 1.1 scw {
533 1.1 scw struct utoppy_header *h;
534 1.1 scw usbd_status err;
535 1.1 scw uint32_t len;
536 1.1 scw uint16_t dlen, crc;
537 1.1 scw uint8_t *data, *e, t1, t2;
538 1.1 scw
539 1.1 scw h = sc->sc_out_data;
540 1.1 scw
541 1.1 scw DPRINTF(UTOPPY_DBG_SEND_PACKET, ("%s: utoppy_send_packet: cmd 0x%04x, "
542 1.15 dyoung "len %d\n", device_xname(sc->sc_dev), (u_int)cmd, h->h_len));
543 1.1 scw
544 1.1 scw dlen = h->h_len;
545 1.1 scw len = dlen + UTOPPY_HEADER_SIZE;
546 1.1 scw
547 1.1 scw if (len & 1)
548 1.1 scw len++;
549 1.1 scw if ((len % 64) == 0)
550 1.1 scw len += 2;
551 1.1 scw
552 1.1 scw if (len >= UTOPPY_BSIZE) {
553 1.1 scw DPRINTF(UTOPPY_DBG_SEND_PACKET, ("%s: utoppy_send_packet: "
554 1.15 dyoung "packet too big (%d)\n", device_xname(sc->sc_dev), (int)len));
555 1.1 scw return (EINVAL);
556 1.1 scw }
557 1.1 scw
558 1.1 scw h->h_len = htole16(dlen + UTOPPY_HEADER_SIZE);
559 1.1 scw h->h_cmd2 = 0;
560 1.1 scw h->h_cmd = htole16(cmd);
561 1.1 scw
562 1.1 scw /* The command word is part of the CRC */
563 1.1 scw crc = UTOPPY_CRC16(0, 0);
564 1.1 scw crc = UTOPPY_CRC16(crc, 0);
565 1.1 scw crc = UTOPPY_CRC16(crc, cmd >> 8);
566 1.1 scw crc = UTOPPY_CRC16(crc, cmd);
567 1.1 scw
568 1.1 scw /*
569 1.1 scw * If there is data following the header, calculate the CRC and
570 1.1 scw * byte-swap as we go.
571 1.1 scw */
572 1.1 scw if (dlen) {
573 1.1 scw data = h->h_data;
574 1.1 scw e = data + (dlen & ~1);
575 1.1 scw
576 1.1 scw do {
577 1.1 scw t1 = data[0];
578 1.1 scw t2 = data[1];
579 1.1 scw crc = UTOPPY_CRC16(crc, t1);
580 1.1 scw crc = UTOPPY_CRC16(crc, t2);
581 1.1 scw *data++ = t2;
582 1.1 scw *data++ = t1;
583 1.1 scw } while (data < e);
584 1.1 scw
585 1.1 scw if (dlen & 1) {
586 1.1 scw t1 = data[0];
587 1.1 scw crc = UTOPPY_CRC16(crc, t1);
588 1.1 scw data[1] = t1;
589 1.1 scw }
590 1.1 scw }
591 1.1 scw
592 1.1 scw h->h_crc = htole16(crc);
593 1.1 scw data = sc->sc_out_data;
594 1.1 scw
595 1.1 scw DPRINTF(UTOPPY_DBG_SEND_PACKET, ("%s: utoppy_send_packet: total len "
596 1.15 dyoung "%d...\n", device_xname(sc->sc_dev), (int)len));
597 1.1 scw DDUMP_PACKET(data, len);
598 1.1 scw
599 1.1 scw do {
600 1.1 scw uint32_t thislen;
601 1.1 scw
602 1.1 scw thislen = min(len, UTOPPY_FRAG_SIZE);
603 1.1 scw
604 1.1 scw memcpy(sc->sc_out_buf, data, thislen);
605 1.1 scw
606 1.1 scw err = utoppy_bulk_transfer(sc->sc_out_xfer, sc->sc_out_pipe,
607 1.1 scw USBD_NO_COPY, timeout, sc->sc_out_buf, &thislen,
608 1.1 scw "utoppytx");
609 1.1 scw
610 1.1 scw if (thislen != min(len, UTOPPY_FRAG_SIZE)) {
611 1.1 scw DPRINTF(UTOPPY_DBG_SEND_PACKET, ("%s: "
612 1.1 scw "utoppy_send_packet: sent %ld, err %d\n",
613 1.15 dyoung device_xname(sc->sc_dev), (u_long)thislen, err));
614 1.1 scw }
615 1.1 scw
616 1.1 scw if (err == 0) {
617 1.1 scw len -= thislen;
618 1.1 scw data += thislen;
619 1.1 scw }
620 1.1 scw } while (err == 0 && len);
621 1.1 scw
622 1.1 scw DPRINTF(UTOPPY_DBG_SEND_PACKET, ("%s: utoppy_send_packet: "
623 1.15 dyoung "usbd_bulk_transfer() returned %d.\n", device_xname(sc->sc_dev),err));
624 1.1 scw
625 1.1 scw return (err ? utoppy_usbd_status2errno(err) : 0);
626 1.1 scw }
627 1.1 scw
628 1.1 scw static int
629 1.1 scw utoppy_recv_packet(struct utoppy_softc *sc, uint16_t *respp, uint32_t timeout)
630 1.1 scw {
631 1.1 scw struct utoppy_header *h;
632 1.1 scw usbd_status err;
633 1.1 scw uint32_t len, thislen, requested, bytesleft;
634 1.4 scw uint16_t crc;
635 1.1 scw uint8_t *data, *e, t1, t2;
636 1.1 scw
637 1.1 scw data = sc->sc_in_data;
638 1.1 scw len = 0;
639 1.1 scw bytesleft = UTOPPY_BSIZE;
640 1.1 scw
641 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: ...\n",
642 1.15 dyoung device_xname(sc->sc_dev)));
643 1.1 scw
644 1.1 scw do {
645 1.1 scw requested = thislen = min(bytesleft, UTOPPY_FRAG_SIZE);
646 1.1 scw
647 1.1 scw err = utoppy_bulk_transfer(sc->sc_in_xfer, sc->sc_in_pipe,
648 1.1 scw USBD_NO_COPY | USBD_SHORT_XFER_OK, timeout, sc->sc_in_buf,
649 1.1 scw &thislen, "utoppyrx");
650 1.1 scw
651 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: "
652 1.1 scw "usbd_bulk_transfer() returned %d, thislen %d, data %p\n",
653 1.15 dyoung device_xname(sc->sc_dev), err, (u_int)thislen, data));
654 1.1 scw
655 1.1 scw if (err == 0) {
656 1.1 scw memcpy(data, sc->sc_in_buf, thislen);
657 1.1 scw DDUMP_PACKET(data, thislen);
658 1.1 scw len += thislen;
659 1.1 scw bytesleft -= thislen;
660 1.1 scw data += thislen;
661 1.1 scw }
662 1.1 scw } while (err == 0 && bytesleft && thislen == requested);
663 1.1 scw
664 1.1 scw if (err)
665 1.1 scw return (utoppy_usbd_status2errno(err));
666 1.1 scw
667 1.1 scw h = sc->sc_in_data;
668 1.1 scw
669 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: received %d "
670 1.15 dyoung "bytes in total to %p\n", device_xname(sc->sc_dev), (u_int)len, h));
671 1.1 scw DDUMP_PACKET(h, len);
672 1.1 scw
673 1.1 scw if (len < UTOPPY_HEADER_SIZE || len < (uint32_t)le16toh(h->h_len)) {
674 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: bad "
675 1.15 dyoung " length (len %d, h_len %d)\n", device_xname(sc->sc_dev),
676 1.1 scw (int)len, le16toh(h->h_len)));
677 1.1 scw return (EIO);
678 1.1 scw }
679 1.1 scw
680 1.1 scw len = h->h_len = le16toh(h->h_len);
681 1.1 scw h->h_crc = le16toh(h->h_crc);
682 1.1 scw *respp = h->h_cmd = le16toh(h->h_cmd);
683 1.1 scw h->h_cmd2 = le16toh(h->h_cmd2);
684 1.1 scw
685 1.1 scw /*
686 1.1 scw * To maximise data throughput when transferring files, acknowledge
687 1.1 scw * data blocks as soon as we receive them. If we detect an error
688 1.1 scw * later on, we can always cancel.
689 1.1 scw */
690 1.1 scw if (*respp == UTOPPY_RESP_FILE_DATA) {
691 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: "
692 1.15 dyoung "ACKing file data\n", device_xname(sc->sc_dev)));
693 1.1 scw
694 1.1 scw UTOPPY_OUT_INIT(sc);
695 1.1 scw err = utoppy_send_packet(sc, UTOPPY_CMD_ACK,
696 1.1 scw UTOPPY_SHORT_TIMEOUT);
697 1.1 scw if (err) {
698 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: "
699 1.1 scw "utoppy_recv_packet: failed to ACK file data: %d\n",
700 1.15 dyoung device_xname(sc->sc_dev), err));
701 1.1 scw return (err);
702 1.1 scw }
703 1.1 scw }
704 1.1 scw
705 1.1 scw /* The command word is part of the CRC */
706 1.4 scw crc = UTOPPY_CRC16(0, h->h_cmd2 >> 8);
707 1.4 scw crc = UTOPPY_CRC16(crc, h->h_cmd2);
708 1.1 scw crc = UTOPPY_CRC16(crc, h->h_cmd >> 8);
709 1.1 scw crc = UTOPPY_CRC16(crc, h->h_cmd);
710 1.1 scw
711 1.1 scw /*
712 1.1 scw * Extract any payload, byte-swapping and calculating the CRC16
713 1.1 scw * as we go.
714 1.1 scw */
715 1.1 scw if (len > UTOPPY_HEADER_SIZE) {
716 1.1 scw data = h->h_data;
717 1.1 scw e = data + ((len & ~1) - UTOPPY_HEADER_SIZE);
718 1.1 scw
719 1.1 scw while (data < e) {
720 1.1 scw t1 = data[0];
721 1.1 scw t2 = data[1];
722 1.1 scw crc = UTOPPY_CRC16(crc, t2);
723 1.1 scw crc = UTOPPY_CRC16(crc, t1);
724 1.1 scw *data++ = t2;
725 1.1 scw *data++ = t1;
726 1.1 scw }
727 1.1 scw
728 1.1 scw if (len & 1) {
729 1.1 scw t1 = data[1];
730 1.1 scw crc = UTOPPY_CRC16(crc, t1);
731 1.1 scw *data = t1;
732 1.1 scw }
733 1.1 scw }
734 1.1 scw
735 1.1 scw sc->sc_in_len = (size_t) len - UTOPPY_HEADER_SIZE;
736 1.1 scw sc->sc_in_offset = 0;
737 1.1 scw
738 1.1 scw DPRINTF(UTOPPY_DBG_RECV_PACKET, ("%s: utoppy_recv_packet: len %d, "
739 1.15 dyoung "crc 0x%04x, hdrcrc 0x%04x\n", device_xname(sc->sc_dev),
740 1.1 scw (int)len, crc, h->h_crc));
741 1.1 scw DDUMP_PACKET(h, len);
742 1.1 scw
743 1.1 scw return ((crc == h->h_crc) ? 0 : EBADMSG);
744 1.1 scw }
745 1.1 scw
746 1.1 scw static __inline void *
747 1.1 scw utoppy_current_ptr(void *b)
748 1.1 scw {
749 1.1 scw struct utoppy_header *h = b;
750 1.1 scw
751 1.1 scw return (&h->h_data[h->h_len]);
752 1.1 scw }
753 1.1 scw
754 1.1 scw static __inline void
755 1.1 scw utoppy_advance_ptr(void *b, size_t len)
756 1.1 scw {
757 1.1 scw struct utoppy_header *h = b;
758 1.1 scw
759 1.1 scw h->h_len += len;
760 1.1 scw }
761 1.1 scw
762 1.1 scw static __inline void
763 1.1 scw utoppy_add_8(struct utoppy_softc *sc, uint8_t v)
764 1.1 scw {
765 1.1 scw struct utoppy_header *h = sc->sc_out_data;
766 1.1 scw uint8_t *p;
767 1.1 scw
768 1.1 scw p = utoppy_current_ptr(h);
769 1.1 scw *p = v;
770 1.1 scw utoppy_advance_ptr(h, sizeof(v));
771 1.1 scw }
772 1.1 scw
773 1.1 scw static __inline void
774 1.1 scw utoppy_add_16(struct utoppy_softc *sc, uint16_t v)
775 1.1 scw {
776 1.1 scw struct utoppy_header *h = sc->sc_out_data;
777 1.1 scw uint8_t *p;
778 1.1 scw
779 1.1 scw p = utoppy_current_ptr(h);
780 1.1 scw *p++ = (uint8_t)(v >> 8);
781 1.1 scw *p = (uint8_t)v;
782 1.1 scw utoppy_advance_ptr(h, sizeof(v));
783 1.1 scw }
784 1.1 scw
785 1.1 scw static __inline void
786 1.1 scw utoppy_add_32(struct utoppy_softc *sc, uint32_t v)
787 1.1 scw {
788 1.1 scw struct utoppy_header *h = sc->sc_out_data;
789 1.1 scw uint8_t *p;
790 1.1 scw
791 1.1 scw p = utoppy_current_ptr(h);
792 1.1 scw *p++ = (uint8_t)(v >> 24);
793 1.1 scw *p++ = (uint8_t)(v >> 16);
794 1.1 scw *p++ = (uint8_t)(v >> 8);
795 1.1 scw *p = (uint8_t)v;
796 1.1 scw utoppy_advance_ptr(h, sizeof(v));
797 1.1 scw }
798 1.1 scw
799 1.1 scw static __inline void
800 1.1 scw utoppy_add_64(struct utoppy_softc *sc, uint64_t v)
801 1.1 scw {
802 1.1 scw struct utoppy_header *h = sc->sc_out_data;
803 1.1 scw uint8_t *p;
804 1.1 scw
805 1.1 scw p = utoppy_current_ptr(h);
806 1.1 scw *p++ = (uint8_t)(v >> 56);
807 1.1 scw *p++ = (uint8_t)(v >> 48);
808 1.1 scw *p++ = (uint8_t)(v >> 40);
809 1.1 scw *p++ = (uint8_t)(v >> 32);
810 1.1 scw *p++ = (uint8_t)(v >> 24);
811 1.1 scw *p++ = (uint8_t)(v >> 16);
812 1.1 scw *p++ = (uint8_t)(v >> 8);
813 1.1 scw *p = (uint8_t)v;
814 1.1 scw utoppy_advance_ptr(h, sizeof(v));
815 1.1 scw }
816 1.1 scw
817 1.1 scw static __inline void
818 1.1 scw utoppy_add_string(struct utoppy_softc *sc, const char *str, size_t len)
819 1.1 scw {
820 1.1 scw struct utoppy_header *h = sc->sc_out_data;
821 1.1 scw char *p;
822 1.1 scw
823 1.1 scw p = utoppy_current_ptr(h);
824 1.1 scw memset(p, 0, len);
825 1.1 scw strncpy(p, str, len);
826 1.1 scw utoppy_advance_ptr(h, len);
827 1.1 scw }
828 1.1 scw
829 1.1 scw static int
830 1.1 scw utoppy_add_path(struct utoppy_softc *sc, const char *path, int putlen)
831 1.1 scw {
832 1.1 scw struct utoppy_header *h = sc->sc_out_data;
833 1.1 scw uint8_t *p, *str, *s;
834 1.1 scw size_t len;
835 1.1 scw int err;
836 1.1 scw
837 1.1 scw p = utoppy_current_ptr(h);
838 1.1 scw
839 1.1 scw str = putlen ? (p + sizeof(uint16_t)) : p;
840 1.1 scw
841 1.1 scw err = copyinstr(path, str, UTOPPY_MAX_FILENAME_LEN, &len);
842 1.1 scw
843 1.1 scw DPRINTF(UTOPPY_DBG_ADDPATH, ("utoppy_add_path: err %d, len %d\n",
844 1.1 scw err, (int)len));
845 1.1 scw
846 1.1 scw if (err)
847 1.1 scw return (err);
848 1.1 scw
849 1.1 scw if (len < 2)
850 1.1 scw return (EINVAL);
851 1.1 scw
852 1.1 scw /*
853 1.1 scw * copyinstr(9) has already copied the terminating NUL character,
854 1.1 scw * but we append another one in case we have to pad the length
855 1.1 scw * later on.
856 1.1 scw */
857 1.1 scw str[len] = '\0';
858 1.1 scw
859 1.1 scw /*
860 1.1 scw * The Toppy uses backslash as the directory separator, so convert
861 1.1 scw * all forward slashes.
862 1.1 scw */
863 1.1 scw for (s = &str[len - 2]; s >= str; s--)
864 1.1 scw if (*s == '/')
865 1.1 scw *s = '\\';
866 1.1 scw
867 1.1 scw if ((len + h->h_len) & 1)
868 1.1 scw len++;
869 1.1 scw
870 1.1 scw if (putlen)
871 1.1 scw utoppy_add_16(sc, len);
872 1.1 scw
873 1.1 scw utoppy_advance_ptr(h, len);
874 1.1 scw
875 1.1 scw DPRINTF(UTOPPY_DBG_ADDPATH, ("utoppy_add_path: final len %d\n",
876 1.1 scw (u_int)len));
877 1.1 scw
878 1.1 scw return (0);
879 1.1 scw }
880 1.1 scw
881 1.1 scw static __inline int
882 1.1 scw utoppy_get_8(struct utoppy_softc *sc, uint8_t *vp)
883 1.1 scw {
884 1.1 scw uint8_t *p;
885 1.1 scw
886 1.1 scw if (sc->sc_in_len < sizeof(*vp))
887 1.1 scw return (1);
888 1.1 scw
889 1.1 scw p = UTOPPY_IN_DATA(sc);
890 1.1 scw *vp = *p;
891 1.1 scw sc->sc_in_offset += sizeof(*vp);
892 1.1 scw sc->sc_in_len -= sizeof(*vp);
893 1.1 scw return (0);
894 1.1 scw }
895 1.1 scw
896 1.1 scw static __inline int
897 1.1 scw utoppy_get_16(struct utoppy_softc *sc, uint16_t *vp)
898 1.1 scw {
899 1.1 scw uint16_t v;
900 1.1 scw uint8_t *p;
901 1.1 scw
902 1.1 scw if (sc->sc_in_len < sizeof(v))
903 1.1 scw return (1);
904 1.1 scw
905 1.1 scw p = UTOPPY_IN_DATA(sc);
906 1.1 scw v = *p++;
907 1.1 scw v = (v << 8) | *p;
908 1.1 scw *vp = v;
909 1.1 scw sc->sc_in_offset += sizeof(v);
910 1.1 scw sc->sc_in_len -= sizeof(v);
911 1.1 scw return (0);
912 1.1 scw }
913 1.1 scw
914 1.1 scw static __inline int
915 1.1 scw utoppy_get_32(struct utoppy_softc *sc, uint32_t *vp)
916 1.1 scw {
917 1.1 scw uint32_t v;
918 1.1 scw uint8_t *p;
919 1.1 scw
920 1.1 scw if (sc->sc_in_len < sizeof(v))
921 1.1 scw return (1);
922 1.1 scw
923 1.1 scw p = UTOPPY_IN_DATA(sc);
924 1.1 scw v = *p++;
925 1.1 scw v = (v << 8) | *p++;
926 1.1 scw v = (v << 8) | *p++;
927 1.1 scw v = (v << 8) | *p;
928 1.1 scw *vp = v;
929 1.1 scw sc->sc_in_offset += sizeof(v);
930 1.1 scw sc->sc_in_len -= sizeof(v);
931 1.1 scw return (0);
932 1.1 scw }
933 1.1 scw
934 1.1 scw static __inline int
935 1.1 scw utoppy_get_64(struct utoppy_softc *sc, uint64_t *vp)
936 1.1 scw {
937 1.1 scw uint64_t v;
938 1.1 scw uint8_t *p;
939 1.1 scw
940 1.1 scw if (sc->sc_in_len < sizeof(v))
941 1.1 scw return (1);
942 1.1 scw
943 1.1 scw p = UTOPPY_IN_DATA(sc);
944 1.1 scw v = *p++;
945 1.1 scw v = (v << 8) | *p++;
946 1.1 scw v = (v << 8) | *p++;
947 1.1 scw v = (v << 8) | *p++;
948 1.1 scw v = (v << 8) | *p++;
949 1.1 scw v = (v << 8) | *p++;
950 1.1 scw v = (v << 8) | *p++;
951 1.1 scw v = (v << 8) | *p;
952 1.1 scw *vp = v;
953 1.1 scw sc->sc_in_offset += sizeof(v);
954 1.1 scw sc->sc_in_len -= sizeof(v);
955 1.1 scw return (0);
956 1.1 scw }
957 1.1 scw
958 1.1 scw static __inline int
959 1.1 scw utoppy_get_string(struct utoppy_softc *sc, char *str, size_t len)
960 1.1 scw {
961 1.1 scw char *p;
962 1.1 scw
963 1.1 scw if (sc->sc_in_len < len)
964 1.1 scw return (1);
965 1.1 scw
966 1.1 scw memset(str, 0, len);
967 1.1 scw p = UTOPPY_IN_DATA(sc);
968 1.1 scw strncpy(str, p, len);
969 1.1 scw sc->sc_in_offset += len;
970 1.1 scw sc->sc_in_len -= len;
971 1.1 scw return (0);
972 1.1 scw }
973 1.1 scw
974 1.1 scw static int
975 1.1 scw utoppy_command(struct utoppy_softc *sc, uint16_t cmd, int timeout,
976 1.1 scw uint16_t *presp)
977 1.1 scw {
978 1.1 scw int err;
979 1.1 scw
980 1.1 scw err = utoppy_send_packet(sc, cmd, timeout);
981 1.1 scw if (err)
982 1.1 scw return (err);
983 1.1 scw
984 1.1 scw err = utoppy_recv_packet(sc, presp, timeout);
985 1.1 scw if (err == EBADMSG) {
986 1.1 scw UTOPPY_OUT_INIT(sc);
987 1.1 scw utoppy_send_packet(sc, UTOPPY_RESP_ERROR, timeout);
988 1.1 scw }
989 1.1 scw
990 1.1 scw return (err);
991 1.1 scw }
992 1.1 scw
993 1.1 scw static int
994 1.1 scw utoppy_timestamp_decode(struct utoppy_softc *sc, time_t *tp)
995 1.1 scw {
996 1.1 scw uint16_t mjd;
997 1.1 scw uint8_t hour, minute, sec;
998 1.1 scw uint32_t rv;
999 1.1 scw
1000 1.1 scw if (utoppy_get_16(sc, &mjd) || utoppy_get_8(sc, &hour) ||
1001 1.1 scw utoppy_get_8(sc, &minute) || utoppy_get_8(sc, &sec))
1002 1.1 scw return (1);
1003 1.1 scw
1004 1.1 scw if (mjd == 0xffffu && hour == 0xffu && minute == 0xffu && sec == 0xffu){
1005 1.1 scw *tp = 0;
1006 1.1 scw return (0);
1007 1.1 scw }
1008 1.1 scw
1009 1.1 scw rv = (mjd < UTOPPY_MJD_1970) ? UTOPPY_MJD_1970 : (uint32_t) mjd;
1010 1.1 scw
1011 1.1 scw /* Calculate seconds since 1970 */
1012 1.1 scw rv = (rv - UTOPPY_MJD_1970) * 60 * 60 * 24;
1013 1.1 scw
1014 1.1 scw /* Add in the hours, minutes, and seconds */
1015 1.1 scw rv += (uint32_t)hour * 60 * 60;
1016 1.1 scw rv += (uint32_t)minute * 60;
1017 1.1 scw rv += sec;
1018 1.1 scw *tp = (time_t)rv;
1019 1.1 scw
1020 1.1 scw return (0);
1021 1.1 scw }
1022 1.1 scw
1023 1.1 scw static void
1024 1.1 scw utoppy_timestamp_encode(struct utoppy_softc *sc, time_t t)
1025 1.1 scw {
1026 1.1 scw u_int mjd, hour, minute;
1027 1.1 scw
1028 1.1 scw mjd = t / (60 * 60 * 24);
1029 1.1 scw t -= mjd * 60 * 60 * 24;
1030 1.1 scw
1031 1.1 scw hour = t / (60 * 60);
1032 1.1 scw t -= hour * 60 * 60;
1033 1.1 scw
1034 1.1 scw minute = t / 60;
1035 1.1 scw t -= minute * 60;
1036 1.1 scw
1037 1.1 scw utoppy_add_16(sc, mjd + UTOPPY_MJD_1970);
1038 1.1 scw utoppy_add_8(sc, hour);
1039 1.1 scw utoppy_add_8(sc, minute);
1040 1.1 scw utoppy_add_8(sc, t);
1041 1.1 scw }
1042 1.1 scw
1043 1.1 scw static int
1044 1.1 scw utoppy_turbo_mode(struct utoppy_softc *sc, int state)
1045 1.1 scw {
1046 1.1 scw uint16_t r;
1047 1.1 scw int err;
1048 1.1 scw
1049 1.1 scw UTOPPY_OUT_INIT(sc);
1050 1.1 scw utoppy_add_32(sc, state);
1051 1.1 scw
1052 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_TURBO, UTOPPY_SHORT_TIMEOUT, &r);
1053 1.1 scw if (err)
1054 1.1 scw return (err);
1055 1.1 scw
1056 1.1 scw return ((r == UTOPPY_RESP_SUCCESS) ? 0 : EIO);
1057 1.1 scw }
1058 1.1 scw
1059 1.1 scw static int
1060 1.1 scw utoppy_check_ready(struct utoppy_softc *sc)
1061 1.1 scw {
1062 1.1 scw uint16_t r;
1063 1.1 scw int err;
1064 1.1 scw
1065 1.1 scw UTOPPY_OUT_INIT(sc);
1066 1.1 scw
1067 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_READY, UTOPPY_LONG_TIMEOUT, &r);
1068 1.1 scw if (err)
1069 1.1 scw return (err);
1070 1.1 scw
1071 1.1 scw return ((r == UTOPPY_RESP_SUCCESS) ? 0 : EIO);
1072 1.1 scw }
1073 1.1 scw
1074 1.1 scw static int
1075 1.1 scw utoppy_cancel(struct utoppy_softc *sc)
1076 1.1 scw {
1077 1.1 scw uint16_t r;
1078 1.1 scw int err, i;
1079 1.1 scw
1080 1.1 scw /*
1081 1.1 scw * Issue the cancel command serveral times. the Toppy doesn't
1082 1.1 scw * always respond to the first.
1083 1.1 scw */
1084 1.1 scw for (i = 0; i < 3; i++) {
1085 1.1 scw UTOPPY_OUT_INIT(sc);
1086 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_CANCEL,
1087 1.1 scw UTOPPY_SHORT_TIMEOUT, &r);
1088 1.1 scw if (err == 0 && r == UTOPPY_RESP_SUCCESS)
1089 1.1 scw break;
1090 1.1 scw err = ETIMEDOUT;
1091 1.1 scw }
1092 1.1 scw
1093 1.1 scw if (err)
1094 1.1 scw return (err);
1095 1.1 scw
1096 1.1 scw /*
1097 1.1 scw * Make sure turbo mode is off, otherwise the Toppy will not
1098 1.1 scw * respond to remote control input.
1099 1.1 scw */
1100 1.1 scw (void) utoppy_turbo_mode(sc, 0);
1101 1.1 scw
1102 1.1 scw sc->sc_state = UTOPPY_STATE_IDLE;
1103 1.1 scw return (0);
1104 1.1 scw }
1105 1.1 scw
1106 1.1 scw static int
1107 1.1 scw utoppy_stats(struct utoppy_softc *sc, struct utoppy_stats *us)
1108 1.1 scw {
1109 1.1 scw uint32_t hsize, hfree;
1110 1.1 scw uint16_t r;
1111 1.1 scw int err;
1112 1.1 scw
1113 1.1 scw UTOPPY_OUT_INIT(sc);
1114 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_STATS, UTOPPY_LONG_TIMEOUT, &r);
1115 1.1 scw if (err)
1116 1.1 scw return (err);
1117 1.1 scw
1118 1.1 scw if (r != UTOPPY_RESP_STATS_DATA)
1119 1.1 scw return (EIO);
1120 1.1 scw
1121 1.1 scw if (utoppy_get_32(sc, &hsize) || utoppy_get_32(sc, &hfree))
1122 1.1 scw return (EIO);
1123 1.1 scw
1124 1.1 scw us->us_hdd_size = hsize;
1125 1.1 scw us->us_hdd_size *= 1024;
1126 1.1 scw us->us_hdd_free = hfree;
1127 1.1 scw us->us_hdd_free *= 1024;
1128 1.1 scw
1129 1.1 scw return (0);
1130 1.1 scw }
1131 1.1 scw
1132 1.1 scw static int
1133 1.1 scw utoppy_readdir_next(struct utoppy_softc *sc)
1134 1.1 scw {
1135 1.1 scw uint16_t resp;
1136 1.1 scw int err;
1137 1.1 scw
1138 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: running...\n",
1139 1.15 dyoung device_xname(sc->sc_dev)));
1140 1.1 scw
1141 1.1 scw /*
1142 1.1 scw * Fetch the next READDIR response
1143 1.1 scw */
1144 1.1 scw err = utoppy_recv_packet(sc, &resp, UTOPPY_LONG_TIMEOUT);
1145 1.1 scw if (err) {
1146 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1147 1.1 scw "utoppy_recv_packet() returned %d\n",
1148 1.15 dyoung device_xname(sc->sc_dev), err));
1149 1.1 scw if (err == EBADMSG) {
1150 1.1 scw UTOPPY_OUT_INIT(sc);
1151 1.1 scw utoppy_send_packet(sc, UTOPPY_RESP_ERROR,
1152 1.1 scw UTOPPY_LONG_TIMEOUT);
1153 1.1 scw }
1154 1.1 scw utoppy_cancel(sc);
1155 1.1 scw return (err);
1156 1.1 scw }
1157 1.1 scw
1158 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1159 1.1 scw "utoppy_recv_packet() returned %d, len %ld\n",
1160 1.15 dyoung device_xname(sc->sc_dev), err, (u_long)sc->sc_in_len));
1161 1.1 scw
1162 1.1 scw switch (resp) {
1163 1.1 scw case UTOPPY_RESP_READDIR_DATA:
1164 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1165 1.15 dyoung "UTOPPY_RESP_READDIR_DATA\n", device_xname(sc->sc_dev)));
1166 1.1 scw
1167 1.1 scw UTOPPY_OUT_INIT(sc);
1168 1.1 scw err = utoppy_send_packet(sc, UTOPPY_CMD_ACK,
1169 1.1 scw UTOPPY_LONG_TIMEOUT);
1170 1.1 scw if (err) {
1171 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1172 1.1 scw "utoppy_send_packet(ACK) returned %d\n",
1173 1.15 dyoung device_xname(sc->sc_dev), err));
1174 1.1 scw utoppy_cancel(sc);
1175 1.1 scw return (err);
1176 1.1 scw }
1177 1.1 scw sc->sc_state = UTOPPY_STATE_READDIR;
1178 1.1 scw sc->sc_in_offset = 0;
1179 1.1 scw break;
1180 1.1 scw
1181 1.1 scw case UTOPPY_RESP_READDIR_END:
1182 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1183 1.15 dyoung "UTOPPY_RESP_READDIR_END\n", device_xname(sc->sc_dev)));
1184 1.1 scw
1185 1.1 scw UTOPPY_OUT_INIT(sc);
1186 1.1 scw utoppy_send_packet(sc, UTOPPY_CMD_ACK, UTOPPY_SHORT_TIMEOUT);
1187 1.1 scw sc->sc_state = UTOPPY_STATE_IDLE;
1188 1.1 scw sc->sc_in_len = 0;
1189 1.1 scw break;
1190 1.1 scw
1191 1.1 scw default:
1192 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_next: "
1193 1.15 dyoung "bad response: 0x%x\n", device_xname(sc->sc_dev), resp));
1194 1.1 scw sc->sc_state = UTOPPY_STATE_IDLE;
1195 1.1 scw sc->sc_in_len = 0;
1196 1.1 scw return (EIO);
1197 1.1 scw }
1198 1.1 scw
1199 1.1 scw return (0);
1200 1.1 scw }
1201 1.1 scw
1202 1.1 scw static size_t
1203 1.1 scw utoppy_readdir_decode(struct utoppy_softc *sc, struct utoppy_dirent *ud)
1204 1.1 scw {
1205 1.1 scw uint8_t ftype;
1206 1.1 scw
1207 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_decode: bytes left"
1208 1.15 dyoung " %d\n", device_xname(sc->sc_dev), (int)sc->sc_in_len));
1209 1.1 scw
1210 1.1 scw if (utoppy_timestamp_decode(sc, &ud->ud_mtime) ||
1211 1.1 scw utoppy_get_8(sc, &ftype) || utoppy_get_64(sc, &ud->ud_size) ||
1212 1.1 scw utoppy_get_string(sc, ud->ud_path, UTOPPY_MAX_FILENAME_LEN + 1) ||
1213 1.1 scw utoppy_get_32(sc, &ud->ud_attributes)) {
1214 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_decode: no "
1215 1.15 dyoung "more to decode\n", device_xname(sc->sc_dev)));
1216 1.1 scw return (0);
1217 1.1 scw }
1218 1.1 scw
1219 1.1 scw switch (ftype) {
1220 1.1 scw case UTOPPY_FTYPE_DIR:
1221 1.1 scw ud->ud_type = UTOPPY_DIRENT_DIRECTORY;
1222 1.1 scw break;
1223 1.1 scw case UTOPPY_FTYPE_FILE:
1224 1.1 scw ud->ud_type = UTOPPY_DIRENT_FILE;
1225 1.1 scw break;
1226 1.1 scw default:
1227 1.1 scw ud->ud_type = UTOPPY_DIRENT_UNKNOWN;
1228 1.1 scw break;
1229 1.1 scw }
1230 1.1 scw
1231 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppy_readdir_decode: %s '%s', "
1232 1.15 dyoung "size %lld, time 0x%08lx, attr 0x%08x\n", device_xname(sc->sc_dev),
1233 1.1 scw (ftype == UTOPPY_FTYPE_DIR) ? "DIR" :
1234 1.1 scw ((ftype == UTOPPY_FTYPE_FILE) ? "FILE" : "UNKNOWN"), ud->ud_path,
1235 1.1 scw ud->ud_size, (u_long)ud->ud_mtime, ud->ud_attributes));
1236 1.1 scw
1237 1.1 scw return (1);
1238 1.1 scw }
1239 1.1 scw
1240 1.1 scw static int
1241 1.1 scw utoppy_readfile_next(struct utoppy_softc *sc)
1242 1.1 scw {
1243 1.1 scw uint64_t off;
1244 1.1 scw uint16_t resp;
1245 1.1 scw int err;
1246 1.1 scw
1247 1.1 scw err = utoppy_recv_packet(sc, &resp, UTOPPY_LONG_TIMEOUT);
1248 1.1 scw if (err) {
1249 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1250 1.1 scw "utoppy_recv_packet() returned %d\n",
1251 1.15 dyoung device_xname(sc->sc_dev), err));
1252 1.1 scw utoppy_cancel(sc);
1253 1.1 scw return (err);
1254 1.1 scw }
1255 1.1 scw
1256 1.1 scw switch (resp) {
1257 1.1 scw case UTOPPY_RESP_FILE_HEADER:
1258 1.1 scw /* ACK it */
1259 1.1 scw UTOPPY_OUT_INIT(sc);
1260 1.1 scw err = utoppy_send_packet(sc, UTOPPY_CMD_ACK,
1261 1.1 scw UTOPPY_LONG_TIMEOUT);
1262 1.1 scw if (err) {
1263 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1264 1.1 scw "utoppy_send_packet(UTOPPY_CMD_ACK) returned %d\n",
1265 1.15 dyoung device_xname(sc->sc_dev), err));
1266 1.1 scw utoppy_cancel(sc);
1267 1.1 scw return (err);
1268 1.1 scw }
1269 1.1 scw
1270 1.1 scw sc->sc_in_len = 0;
1271 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1272 1.15 dyoung "FILE_HEADER done\n", device_xname(sc->sc_dev)));
1273 1.1 scw break;
1274 1.1 scw
1275 1.1 scw case UTOPPY_RESP_FILE_DATA:
1276 1.1 scw /* Already ACK'd */
1277 1.1 scw if (utoppy_get_64(sc, &off)) {
1278 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1279 1.1 scw "UTOPPY_RESP_FILE_DATA did not provide offset\n",
1280 1.15 dyoung device_xname(sc->sc_dev)));
1281 1.1 scw utoppy_cancel(sc);
1282 1.1 scw return (EBADMSG);
1283 1.1 scw }
1284 1.1 scw
1285 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1286 1.1 scw "UTOPPY_RESP_FILE_DATA: offset %lld, bytes left %ld\n",
1287 1.15 dyoung device_xname(sc->sc_dev), off, (u_long)sc->sc_in_len));
1288 1.1 scw break;
1289 1.1 scw
1290 1.1 scw case UTOPPY_RESP_FILE_END:
1291 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: "
1292 1.1 scw "UTOPPY_RESP_FILE_END: sending ACK\n",
1293 1.15 dyoung device_xname(sc->sc_dev)));
1294 1.1 scw UTOPPY_OUT_INIT(sc);
1295 1.1 scw utoppy_send_packet(sc, UTOPPY_CMD_ACK, UTOPPY_SHORT_TIMEOUT);
1296 1.1 scw /*FALLTHROUGH*/
1297 1.1 scw
1298 1.1 scw case UTOPPY_RESP_SUCCESS:
1299 1.1 scw sc->sc_state = UTOPPY_STATE_IDLE;
1300 1.1 scw (void) utoppy_turbo_mode(sc, 0);
1301 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: all "
1302 1.15 dyoung "done\n", device_xname(sc->sc_dev)));
1303 1.1 scw break;
1304 1.1 scw
1305 1.1 scw case UTOPPY_RESP_ERROR:
1306 1.1 scw default:
1307 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppy_readfile_next: bad "
1308 1.15 dyoung "response code 0x%0x\n", device_xname(sc->sc_dev), resp));
1309 1.1 scw utoppy_cancel(sc);
1310 1.1 scw return (EIO);
1311 1.1 scw }
1312 1.1 scw
1313 1.1 scw return (0);
1314 1.1 scw }
1315 1.1 scw
1316 1.1 scw int
1317 1.8 christos utoppyopen(dev_t dev, int flag, int mode,
1318 1.8 christos struct lwp *l)
1319 1.1 scw {
1320 1.1 scw struct utoppy_softc *sc;
1321 1.1 scw int error = 0;
1322 1.1 scw
1323 1.15 dyoung sc = device_lookup_private(&utoppy_cd, UTOPPYUNIT(dev));
1324 1.15 dyoung if (sc == NULL)
1325 1.15 dyoung return ENXIO;
1326 1.1 scw
1327 1.1 scw if (sc == NULL || sc->sc_iface == NULL || sc->sc_dying)
1328 1.1 scw return (ENXIO);
1329 1.1 scw
1330 1.1 scw if (sc->sc_state != UTOPPY_STATE_CLOSED) {
1331 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: already open\n",
1332 1.15 dyoung device_xname(sc->sc_dev)));
1333 1.1 scw return (EBUSY);
1334 1.1 scw }
1335 1.1 scw
1336 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: opening...\n",
1337 1.15 dyoung device_xname(sc->sc_dev)));
1338 1.1 scw
1339 1.1 scw sc->sc_refcnt++;
1340 1.1 scw sc->sc_state = UTOPPY_STATE_OPENING;
1341 1.1 scw sc->sc_turbo_mode = 0;
1342 1.1 scw sc->sc_out_pipe = NULL;
1343 1.1 scw sc->sc_in_pipe = NULL;
1344 1.1 scw
1345 1.1 scw if (usbd_open_pipe(sc->sc_iface, sc->sc_out, 0, &sc->sc_out_pipe)) {
1346 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: usbd_open_pipe(OUT) "
1347 1.15 dyoung "failed\n", device_xname(sc->sc_dev)));
1348 1.1 scw error = EIO;
1349 1.1 scw goto done;
1350 1.1 scw }
1351 1.1 scw
1352 1.1 scw if (usbd_open_pipe(sc->sc_iface, sc->sc_in, 0, &sc->sc_in_pipe)) {
1353 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: usbd_open_pipe(IN) "
1354 1.15 dyoung "failed\n", device_xname(sc->sc_dev)));
1355 1.1 scw error = EIO;
1356 1.1 scw usbd_close_pipe(sc->sc_out_pipe);
1357 1.1 scw sc->sc_out_pipe = NULL;
1358 1.5 scw goto done;
1359 1.1 scw }
1360 1.1 scw
1361 1.1 scw sc->sc_out_data = malloc(UTOPPY_BSIZE + 1, M_DEVBUF, M_WAITOK);
1362 1.1 scw if (sc->sc_out_data == NULL) {
1363 1.1 scw error = ENOMEM;
1364 1.1 scw goto error;
1365 1.1 scw }
1366 1.1 scw
1367 1.1 scw sc->sc_in_data = malloc(UTOPPY_BSIZE + 1, M_DEVBUF, M_WAITOK);
1368 1.1 scw if (sc->sc_in_data == NULL) {
1369 1.1 scw free(sc->sc_out_data, M_DEVBUF);
1370 1.1 scw sc->sc_out_data = NULL;
1371 1.1 scw error = ENOMEM;
1372 1.1 scw goto error;
1373 1.1 scw }
1374 1.1 scw
1375 1.1 scw if ((error = utoppy_cancel(sc)) != 0)
1376 1.1 scw goto error;
1377 1.1 scw
1378 1.1 scw if ((error = utoppy_check_ready(sc)) != 0) {
1379 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: utoppy_check_ready()"
1380 1.15 dyoung " returned %d\n", device_xname(sc->sc_dev), error));
1381 1.1 scw error:
1382 1.1 scw usbd_abort_pipe(sc->sc_out_pipe);
1383 1.1 scw usbd_close_pipe(sc->sc_out_pipe);
1384 1.1 scw sc->sc_out_pipe = NULL;
1385 1.1 scw usbd_abort_pipe(sc->sc_in_pipe);
1386 1.1 scw usbd_close_pipe(sc->sc_in_pipe);
1387 1.1 scw sc->sc_in_pipe = NULL;
1388 1.1 scw }
1389 1.1 scw
1390 1.1 scw done:
1391 1.1 scw sc->sc_state = error ? UTOPPY_STATE_CLOSED : UTOPPY_STATE_IDLE;
1392 1.1 scw
1393 1.1 scw DPRINTF(UTOPPY_DBG_OPEN, ("%s: utoppyopen: done. error %d, new state "
1394 1.15 dyoung "'%s'\n", device_xname(sc->sc_dev), error,
1395 1.1 scw utoppy_state_string(sc->sc_state)));
1396 1.1 scw
1397 1.1 scw if (--sc->sc_refcnt < 0)
1398 1.18 mrg usb_detach_wakeupold(sc->sc_dev);
1399 1.1 scw
1400 1.1 scw return (error);
1401 1.1 scw }
1402 1.1 scw
1403 1.1 scw int
1404 1.8 christos utoppyclose(dev_t dev, int flag, int mode,
1405 1.8 christos struct lwp *l)
1406 1.1 scw {
1407 1.1 scw struct utoppy_softc *sc;
1408 1.1 scw usbd_status err;
1409 1.1 scw
1410 1.15 dyoung sc = device_lookup_private(&utoppy_cd, UTOPPYUNIT(dev));
1411 1.1 scw
1412 1.1 scw DPRINTF(UTOPPY_DBG_CLOSE, ("%s: utoppyclose: closing...\n",
1413 1.15 dyoung device_xname(sc->sc_dev)));
1414 1.1 scw
1415 1.1 scw if (sc->sc_state < UTOPPY_STATE_IDLE) {
1416 1.1 scw /* We are being forced to close before the open completed. */
1417 1.1 scw DPRINTF(UTOPPY_DBG_CLOSE, ("%s: utoppyclose: not properly open:"
1418 1.15 dyoung " %s\n", device_xname(sc->sc_dev),
1419 1.1 scw utoppy_state_string(sc->sc_state)));
1420 1.1 scw return (0);
1421 1.1 scw }
1422 1.1 scw
1423 1.3 christos if (sc->sc_out_data)
1424 1.3 christos (void) utoppy_cancel(sc);
1425 1.1 scw
1426 1.1 scw if (sc->sc_out_pipe != NULL) {
1427 1.1 scw if ((err = usbd_abort_pipe(sc->sc_out_pipe)) != 0)
1428 1.1 scw printf("usbd_abort_pipe(OUT) returned %d\n", err);
1429 1.1 scw if ((err = usbd_close_pipe(sc->sc_out_pipe)) != 0)
1430 1.1 scw printf("usbd_close_pipe(OUT) returned %d\n", err);
1431 1.1 scw sc->sc_out_pipe = NULL;
1432 1.1 scw }
1433 1.1 scw
1434 1.1 scw if (sc->sc_in_pipe != NULL) {
1435 1.1 scw if ((err = usbd_abort_pipe(sc->sc_in_pipe)) != 0)
1436 1.1 scw printf("usbd_abort_pipe(IN) returned %d\n", err);
1437 1.1 scw if ((err = usbd_close_pipe(sc->sc_in_pipe)) != 0)
1438 1.1 scw printf("usbd_close_pipe(IN) returned %d\n", err);
1439 1.1 scw sc->sc_in_pipe = NULL;
1440 1.1 scw }
1441 1.1 scw
1442 1.1 scw if (sc->sc_out_data) {
1443 1.1 scw free(sc->sc_out_data, M_DEVBUF);
1444 1.1 scw sc->sc_out_data = NULL;
1445 1.1 scw }
1446 1.1 scw
1447 1.1 scw if (sc->sc_in_data) {
1448 1.1 scw free(sc->sc_in_data, M_DEVBUF);
1449 1.1 scw sc->sc_in_data = NULL;
1450 1.1 scw }
1451 1.1 scw
1452 1.1 scw sc->sc_state = UTOPPY_STATE_CLOSED;
1453 1.1 scw
1454 1.1 scw DPRINTF(UTOPPY_DBG_CLOSE, ("%s: utoppyclose: done.\n",
1455 1.15 dyoung device_xname(sc->sc_dev)));
1456 1.1 scw
1457 1.1 scw return (0);
1458 1.1 scw }
1459 1.1 scw
1460 1.1 scw int
1461 1.8 christos utoppyread(dev_t dev, struct uio *uio, int flags)
1462 1.1 scw {
1463 1.1 scw struct utoppy_softc *sc;
1464 1.1 scw struct utoppy_dirent ud;
1465 1.1 scw size_t len;
1466 1.1 scw int err;
1467 1.1 scw
1468 1.15 dyoung sc = device_lookup_private(&utoppy_cd, UTOPPYUNIT(dev));
1469 1.1 scw
1470 1.1 scw if (sc->sc_dying)
1471 1.1 scw return (EIO);
1472 1.1 scw
1473 1.1 scw sc->sc_refcnt++;
1474 1.1 scw
1475 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppyread: reading: state '%s'\n",
1476 1.15 dyoung device_xname(sc->sc_dev), utoppy_state_string(sc->sc_state)));
1477 1.1 scw
1478 1.1 scw switch (sc->sc_state) {
1479 1.1 scw case UTOPPY_STATE_READDIR:
1480 1.1 scw err = 0;
1481 1.1 scw while (err == 0 && uio->uio_resid >= sizeof(ud) &&
1482 1.1 scw sc->sc_state != UTOPPY_STATE_IDLE) {
1483 1.1 scw if (utoppy_readdir_decode(sc, &ud) == 0)
1484 1.1 scw err = utoppy_readdir_next(sc);
1485 1.1 scw else
1486 1.1 scw if ((err = uiomove(&ud, sizeof(ud), uio)) != 0)
1487 1.17 jakllsch utoppy_cancel(sc);
1488 1.1 scw }
1489 1.1 scw break;
1490 1.1 scw
1491 1.1 scw case UTOPPY_STATE_READFILE:
1492 1.1 scw err = 0;
1493 1.1 scw while (err == 0 && uio->uio_resid > 0 &&
1494 1.1 scw sc->sc_state != UTOPPY_STATE_IDLE) {
1495 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppyread: READFILE: "
1496 1.1 scw "resid %ld, bytes_left %ld\n",
1497 1.15 dyoung device_xname(sc->sc_dev), (u_long)uio->uio_resid,
1498 1.1 scw (u_long)sc->sc_in_len));
1499 1.1 scw
1500 1.1 scw if (sc->sc_in_len == 0 &&
1501 1.1 scw (err = utoppy_readfile_next(sc)) != 0) {
1502 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppyread: "
1503 1.1 scw "READFILE: utoppy_readfile_next returned "
1504 1.15 dyoung "%d\n", device_xname(sc->sc_dev), err));
1505 1.1 scw break;
1506 1.1 scw }
1507 1.1 scw
1508 1.1 scw len = min(uio->uio_resid, sc->sc_in_len);
1509 1.1 scw if (len) {
1510 1.1 scw err = uiomove(UTOPPY_IN_DATA(sc), len, uio);
1511 1.1 scw if (err == 0) {
1512 1.1 scw sc->sc_in_offset += len;
1513 1.1 scw sc->sc_in_len -= len;
1514 1.1 scw }
1515 1.1 scw }
1516 1.1 scw }
1517 1.1 scw break;
1518 1.1 scw
1519 1.1 scw case UTOPPY_STATE_IDLE:
1520 1.1 scw err = 0;
1521 1.1 scw break;
1522 1.1 scw
1523 1.1 scw case UTOPPY_STATE_WRITEFILE:
1524 1.1 scw err = EBUSY;
1525 1.1 scw break;
1526 1.1 scw
1527 1.1 scw default:
1528 1.1 scw err = EIO;
1529 1.1 scw break;
1530 1.1 scw }
1531 1.1 scw
1532 1.1 scw DPRINTF(UTOPPY_DBG_READ, ("%s: utoppyread: done. err %d, state '%s'\n",
1533 1.15 dyoung device_xname(sc->sc_dev), err, utoppy_state_string(sc->sc_state)));
1534 1.1 scw
1535 1.1 scw if (--sc->sc_refcnt < 0)
1536 1.18 mrg usb_detach_wakeupold(sc->sc_dev);
1537 1.1 scw
1538 1.1 scw return (err);
1539 1.1 scw }
1540 1.1 scw
1541 1.1 scw int
1542 1.8 christos utoppywrite(dev_t dev, struct uio *uio, int flags)
1543 1.1 scw {
1544 1.1 scw struct utoppy_softc *sc;
1545 1.1 scw uint16_t resp;
1546 1.1 scw size_t len;
1547 1.1 scw int err;
1548 1.1 scw
1549 1.15 dyoung sc = device_lookup_private(&utoppy_cd, UTOPPYUNIT(dev));
1550 1.1 scw
1551 1.1 scw if (sc->sc_dying)
1552 1.1 scw return (EIO);
1553 1.1 scw
1554 1.1 scw switch(sc->sc_state) {
1555 1.1 scw case UTOPPY_STATE_WRITEFILE:
1556 1.1 scw break;
1557 1.1 scw
1558 1.1 scw case UTOPPY_STATE_IDLE:
1559 1.1 scw return (0);
1560 1.1 scw
1561 1.1 scw default:
1562 1.1 scw return (EIO);
1563 1.1 scw }
1564 1.1 scw
1565 1.1 scw sc->sc_refcnt++;
1566 1.1 scw err = 0;
1567 1.1 scw
1568 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: PRE-WRITEFILE: resid %ld, "
1569 1.15 dyoung "wr_size %lld, wr_offset %lld\n", device_xname(sc->sc_dev),
1570 1.1 scw (u_long)uio->uio_resid, sc->sc_wr_size, sc->sc_wr_offset));
1571 1.1 scw
1572 1.1 scw while (sc->sc_state == UTOPPY_STATE_WRITEFILE &&
1573 1.1 scw (len = min(uio->uio_resid, sc->sc_wr_size)) != 0) {
1574 1.1 scw
1575 1.1 scw len = min(len, UTOPPY_BSIZE - (UTOPPY_HEADER_SIZE +
1576 1.1 scw sizeof(uint64_t) + 3));
1577 1.1 scw
1578 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: uiomove(%ld)\n",
1579 1.15 dyoung device_xname(sc->sc_dev), (u_long)len));
1580 1.1 scw
1581 1.1 scw UTOPPY_OUT_INIT(sc);
1582 1.1 scw utoppy_add_64(sc, sc->sc_wr_offset);
1583 1.1 scw
1584 1.1 scw err = uiomove(utoppy_current_ptr(sc->sc_out_data), len, uio);
1585 1.1 scw if (err) {
1586 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: uiomove() "
1587 1.15 dyoung "returned %d\n", device_xname(sc->sc_dev), err));
1588 1.1 scw break;
1589 1.1 scw }
1590 1.1 scw
1591 1.1 scw utoppy_advance_ptr(sc->sc_out_data, len);
1592 1.1 scw
1593 1.1 scw err = utoppy_command(sc, UTOPPY_RESP_FILE_DATA,
1594 1.1 scw UTOPPY_LONG_TIMEOUT, &resp);
1595 1.1 scw if (err) {
1596 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: "
1597 1.1 scw "utoppy_command(UTOPPY_RESP_FILE_DATA) "
1598 1.15 dyoung "returned %d\n", device_xname(sc->sc_dev), err));
1599 1.1 scw break;
1600 1.1 scw }
1601 1.1 scw if (resp != UTOPPY_RESP_SUCCESS) {
1602 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: "
1603 1.1 scw "utoppy_command(UTOPPY_RESP_FILE_DATA) returned "
1604 1.15 dyoung "bad response 0x%x\n", device_xname(sc->sc_dev),
1605 1.1 scw resp));
1606 1.1 scw utoppy_cancel(sc);
1607 1.1 scw err = EIO;
1608 1.1 scw break;
1609 1.1 scw }
1610 1.1 scw
1611 1.1 scw sc->sc_wr_offset += len;
1612 1.1 scw sc->sc_wr_size -= len;
1613 1.1 scw }
1614 1.1 scw
1615 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: POST-WRITEFILE: resid %ld,"
1616 1.15 dyoung " wr_size %lld, wr_offset %lld, err %d\n", device_xname(sc->sc_dev),
1617 1.1 scw (u_long)uio->uio_resid, sc->sc_wr_size, sc->sc_wr_offset, err));
1618 1.1 scw
1619 1.1 scw if (err == 0 && sc->sc_wr_size == 0) {
1620 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: sending "
1621 1.15 dyoung "FILE_END...\n", device_xname(sc->sc_dev)));
1622 1.1 scw UTOPPY_OUT_INIT(sc);
1623 1.1 scw err = utoppy_command(sc, UTOPPY_RESP_FILE_END,
1624 1.1 scw UTOPPY_LONG_TIMEOUT, &resp);
1625 1.1 scw if (err) {
1626 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: "
1627 1.1 scw "utoppy_command(UTOPPY_RESP_FILE_END) returned "
1628 1.15 dyoung "%d\n", device_xname(sc->sc_dev), err));
1629 1.1 scw
1630 1.1 scw utoppy_cancel(sc);
1631 1.1 scw }
1632 1.1 scw
1633 1.1 scw sc->sc_state = UTOPPY_STATE_IDLE;
1634 1.1 scw DPRINTF(UTOPPY_DBG_WRITE, ("%s: utoppywrite: state %s\n",
1635 1.15 dyoung device_xname(sc->sc_dev), utoppy_state_string(sc->sc_state)));
1636 1.1 scw }
1637 1.1 scw
1638 1.1 scw if (--sc->sc_refcnt < 0)
1639 1.18 mrg usb_detach_wakeupold(sc->sc_dev);
1640 1.1 scw
1641 1.1 scw return (err);
1642 1.1 scw }
1643 1.1 scw
1644 1.1 scw int
1645 1.9 christos utoppyioctl(dev_t dev, u_long cmd, void *data, int flag,
1646 1.8 christos struct lwp *l)
1647 1.1 scw {
1648 1.1 scw struct utoppy_softc *sc;
1649 1.1 scw struct utoppy_rename *ur;
1650 1.1 scw struct utoppy_readfile *urf;
1651 1.1 scw struct utoppy_writefile *uw;
1652 1.1 scw char uwf[UTOPPY_MAX_FILENAME_LEN + 1], *uwfp;
1653 1.1 scw uint16_t resp;
1654 1.1 scw int err;
1655 1.1 scw
1656 1.15 dyoung sc = device_lookup_private(&utoppy_cd, UTOPPYUNIT(dev));
1657 1.1 scw
1658 1.1 scw if (sc->sc_dying)
1659 1.1 scw return (EIO);
1660 1.1 scw
1661 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: cmd 0x%08lx, state '%s'\n",
1662 1.15 dyoung device_xname(sc->sc_dev), cmd, utoppy_state_string(sc->sc_state)));
1663 1.1 scw
1664 1.1 scw if (sc->sc_state != UTOPPY_STATE_IDLE && cmd != UTOPPYIOCANCEL) {
1665 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: still busy.\n",
1666 1.15 dyoung device_xname(sc->sc_dev)));
1667 1.1 scw return (EBUSY);
1668 1.1 scw }
1669 1.1 scw
1670 1.1 scw sc->sc_refcnt++;
1671 1.1 scw
1672 1.1 scw switch (cmd) {
1673 1.1 scw case UTOPPYIOTURBO:
1674 1.1 scw err = 0;
1675 1.1 scw sc->sc_turbo_mode = *((int *)data) ? 1 : 0;
1676 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOTURBO: "
1677 1.15 dyoung "%s\n", device_xname(sc->sc_dev), sc->sc_turbo_mode ? "On" :
1678 1.1 scw "Off"));
1679 1.1 scw break;
1680 1.1 scw
1681 1.1 scw case UTOPPYIOCANCEL:
1682 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOCANCEL\n",
1683 1.15 dyoung device_xname(sc->sc_dev)));
1684 1.1 scw err = utoppy_cancel(sc);
1685 1.1 scw break;
1686 1.1 scw
1687 1.1 scw case UTOPPYIOREBOOT:
1688 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOREBOOT\n",
1689 1.15 dyoung device_xname(sc->sc_dev)));
1690 1.1 scw UTOPPY_OUT_INIT(sc);
1691 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_RESET, UTOPPY_LONG_TIMEOUT,
1692 1.1 scw &resp);
1693 1.1 scw if (err)
1694 1.1 scw break;
1695 1.1 scw
1696 1.1 scw if (resp != UTOPPY_RESP_SUCCESS)
1697 1.1 scw err = EIO;
1698 1.1 scw break;
1699 1.1 scw
1700 1.1 scw case UTOPPYIOSTATS:
1701 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOSTATS\n",
1702 1.15 dyoung device_xname(sc->sc_dev)));
1703 1.1 scw err = utoppy_stats(sc, (struct utoppy_stats *)data);
1704 1.1 scw break;
1705 1.1 scw
1706 1.1 scw case UTOPPYIORENAME:
1707 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIORENAME\n",
1708 1.15 dyoung device_xname(sc->sc_dev)));
1709 1.1 scw ur = (struct utoppy_rename *)data;
1710 1.1 scw UTOPPY_OUT_INIT(sc);
1711 1.1 scw
1712 1.1 scw if ((err = utoppy_add_path(sc, ur->ur_old_path, 1)) != 0)
1713 1.1 scw break;
1714 1.1 scw if ((err = utoppy_add_path(sc, ur->ur_new_path, 1)) != 0)
1715 1.1 scw break;
1716 1.1 scw
1717 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_RENAME, UTOPPY_LONG_TIMEOUT,
1718 1.1 scw &resp);
1719 1.1 scw if (err)
1720 1.1 scw break;
1721 1.1 scw
1722 1.1 scw if (resp != UTOPPY_RESP_SUCCESS)
1723 1.1 scw err = EIO;
1724 1.1 scw break;
1725 1.1 scw
1726 1.1 scw case UTOPPYIOMKDIR:
1727 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOMKDIR\n",
1728 1.15 dyoung device_xname(sc->sc_dev)));
1729 1.1 scw UTOPPY_OUT_INIT(sc);
1730 1.1 scw err = utoppy_add_path(sc, *((const char **)data), 1);
1731 1.1 scw if (err)
1732 1.1 scw break;
1733 1.1 scw
1734 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_MKDIR, UTOPPY_LONG_TIMEOUT,
1735 1.1 scw &resp);
1736 1.1 scw if (err)
1737 1.1 scw break;
1738 1.1 scw
1739 1.1 scw if (resp != UTOPPY_RESP_SUCCESS)
1740 1.1 scw err = EIO;
1741 1.1 scw break;
1742 1.1 scw
1743 1.1 scw case UTOPPYIODELETE:
1744 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIODELETE\n",
1745 1.15 dyoung device_xname(sc->sc_dev)));
1746 1.1 scw UTOPPY_OUT_INIT(sc);
1747 1.1 scw err = utoppy_add_path(sc, *((const char **)data), 0);
1748 1.1 scw if (err)
1749 1.1 scw break;
1750 1.1 scw
1751 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_DELETE, UTOPPY_LONG_TIMEOUT,
1752 1.1 scw &resp);
1753 1.1 scw if (err)
1754 1.1 scw break;
1755 1.1 scw
1756 1.1 scw if (resp != UTOPPY_RESP_SUCCESS)
1757 1.1 scw err = EIO;
1758 1.1 scw break;
1759 1.1 scw
1760 1.1 scw case UTOPPYIOREADDIR:
1761 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL, ("%s: utoppyioctl: UTOPPYIOREADDIR\n",
1762 1.15 dyoung device_xname(sc->sc_dev)));
1763 1.1 scw UTOPPY_OUT_INIT(sc);
1764 1.1 scw err = utoppy_add_path(sc, *((const char **)data), 0);
1765 1.1 scw if (err) {
1766 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppyioctl: "
1767 1.1 scw "utoppy_add_path() returned %d\n",
1768 1.15 dyoung device_xname(sc->sc_dev), err));
1769 1.1 scw break;
1770 1.1 scw }
1771 1.1 scw
1772 1.1 scw err = utoppy_send_packet(sc, UTOPPY_CMD_READDIR,
1773 1.1 scw UTOPPY_LONG_TIMEOUT);
1774 1.1 scw if (err != 0) {
1775 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppyioctl: "
1776 1.1 scw "UTOPPY_CMD_READDIR returned %d\n",
1777 1.15 dyoung device_xname(sc->sc_dev), err));
1778 1.1 scw break;
1779 1.1 scw }
1780 1.1 scw
1781 1.1 scw err = utoppy_readdir_next(sc);
1782 1.1 scw if (err) {
1783 1.1 scw DPRINTF(UTOPPY_DBG_READDIR, ("%s: utoppyioctl: "
1784 1.1 scw "utoppy_readdir_next() returned %d\n",
1785 1.15 dyoung device_xname(sc->sc_dev), err));
1786 1.1 scw }
1787 1.1 scw break;
1788 1.1 scw
1789 1.1 scw case UTOPPYIOREADFILE:
1790 1.1 scw urf = (struct utoppy_readfile *)data;
1791 1.1 scw
1792 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL,("%s: utoppyioctl: UTOPPYIOREADFILE "
1793 1.15 dyoung "%s, offset %lld\n", device_xname(sc->sc_dev), urf->ur_path,
1794 1.1 scw urf->ur_offset));
1795 1.1 scw
1796 1.1 scw if ((err = utoppy_turbo_mode(sc, sc->sc_turbo_mode)) != 0)
1797 1.1 scw break;
1798 1.1 scw
1799 1.1 scw UTOPPY_OUT_INIT(sc);
1800 1.1 scw utoppy_add_8(sc, UTOPPY_FILE_READ);
1801 1.1 scw
1802 1.1 scw if ((err = utoppy_add_path(sc, urf->ur_path, 1)) != 0)
1803 1.1 scw break;
1804 1.1 scw
1805 1.1 scw utoppy_add_64(sc, urf->ur_offset);
1806 1.1 scw
1807 1.1 scw sc->sc_state = UTOPPY_STATE_READFILE;
1808 1.1 scw sc->sc_in_offset = 0;
1809 1.1 scw
1810 1.1 scw err = utoppy_send_packet(sc, UTOPPY_CMD_FILE,
1811 1.1 scw UTOPPY_LONG_TIMEOUT);
1812 1.1 scw if (err == 0)
1813 1.1 scw err = utoppy_readfile_next(sc);
1814 1.1 scw break;
1815 1.1 scw
1816 1.1 scw case UTOPPYIOWRITEFILE:
1817 1.1 scw uw = (struct utoppy_writefile *)data;
1818 1.1 scw
1819 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL,("%s: utoppyioctl: UTOPPYIOWRITEFILE "
1820 1.15 dyoung "%s, size %lld, offset %lld\n", device_xname(sc->sc_dev),
1821 1.1 scw uw->uw_path, uw->uw_size, uw->uw_offset));
1822 1.1 scw
1823 1.1 scw if ((err = utoppy_turbo_mode(sc, sc->sc_turbo_mode)) != 0)
1824 1.1 scw break;
1825 1.1 scw
1826 1.1 scw UTOPPY_OUT_INIT(sc);
1827 1.1 scw utoppy_add_8(sc, UTOPPY_FILE_WRITE);
1828 1.1 scw uwfp = utoppy_current_ptr(sc->sc_out_data);
1829 1.1 scw
1830 1.1 scw if ((err = utoppy_add_path(sc, uw->uw_path, 1)) != 0) {
1831 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: add_path() "
1832 1.15 dyoung "returned %d\n", device_xname(sc->sc_dev), err));
1833 1.1 scw break;
1834 1.1 scw }
1835 1.1 scw
1836 1.1 scw strncpy(uwf, &uwfp[2], sizeof(uwf));
1837 1.1 scw utoppy_add_64(sc, uw->uw_offset);
1838 1.1 scw
1839 1.1 scw err = utoppy_command(sc, UTOPPY_CMD_FILE, UTOPPY_LONG_TIMEOUT,
1840 1.1 scw &resp);
1841 1.1 scw if (err) {
1842 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: "
1843 1.1 scw "utoppy_command(UTOPPY_CMD_FILE) returned "
1844 1.15 dyoung "%d\n", device_xname(sc->sc_dev), err));
1845 1.1 scw break;
1846 1.1 scw }
1847 1.1 scw if (resp != UTOPPY_RESP_SUCCESS) {
1848 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: "
1849 1.1 scw "utoppy_command(UTOPPY_CMD_FILE) returned "
1850 1.15 dyoung "bad response 0x%x\n", device_xname(sc->sc_dev),
1851 1.1 scw resp));
1852 1.1 scw err = EIO;
1853 1.1 scw break;
1854 1.1 scw }
1855 1.1 scw
1856 1.1 scw UTOPPY_OUT_INIT(sc);
1857 1.1 scw utoppy_timestamp_encode(sc, uw->uw_mtime);
1858 1.1 scw utoppy_add_8(sc, UTOPPY_FTYPE_FILE);
1859 1.1 scw utoppy_add_64(sc, uw->uw_size);
1860 1.1 scw utoppy_add_string(sc, uwf, sizeof(uwf));
1861 1.1 scw utoppy_add_32(sc, 0);
1862 1.1 scw
1863 1.1 scw err = utoppy_command(sc, UTOPPY_RESP_FILE_HEADER,
1864 1.1 scw UTOPPY_LONG_TIMEOUT, &resp);
1865 1.1 scw if (err) {
1866 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: "
1867 1.1 scw "utoppy_command(UTOPPY_RESP_FILE_HEADER) "
1868 1.15 dyoung "returned %d\n", device_xname(sc->sc_dev), err));
1869 1.1 scw break;
1870 1.1 scw }
1871 1.1 scw if (resp != UTOPPY_RESP_SUCCESS) {
1872 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: "
1873 1.1 scw "utoppy_command(UTOPPY_RESP_FILE_HEADER) "
1874 1.1 scw "returned bad response 0x%x\n",
1875 1.15 dyoung device_xname(sc->sc_dev), resp));
1876 1.1 scw err = EIO;
1877 1.1 scw break;
1878 1.1 scw }
1879 1.1 scw
1880 1.1 scw sc->sc_wr_offset = uw->uw_offset;
1881 1.1 scw sc->sc_wr_size = uw->uw_size;
1882 1.1 scw sc->sc_state = UTOPPY_STATE_WRITEFILE;
1883 1.1 scw
1884 1.1 scw DPRINTF(UTOPPY_DBG_WRITE,("%s: utoppyioctl: Changing state to "
1885 1.1 scw "%s. wr_offset %lld, wr_size %lld\n",
1886 1.15 dyoung device_xname(sc->sc_dev), utoppy_state_string(sc->sc_state),
1887 1.1 scw sc->sc_wr_offset, sc->sc_wr_size));
1888 1.1 scw break;
1889 1.1 scw
1890 1.1 scw default:
1891 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL,("%s: utoppyioctl: Invalid cmd\n",
1892 1.15 dyoung device_xname(sc->sc_dev)));
1893 1.1 scw err = ENODEV;
1894 1.1 scw break;
1895 1.1 scw }
1896 1.1 scw
1897 1.1 scw DPRINTF(UTOPPY_DBG_IOCTL,("%s: utoppyioctl: done. err %d, state '%s'\n",
1898 1.15 dyoung device_xname(sc->sc_dev), err, utoppy_state_string(sc->sc_state)));
1899 1.1 scw
1900 1.1 scw if (err)
1901 1.1 scw utoppy_cancel(sc);
1902 1.1 scw
1903 1.1 scw if (--sc->sc_refcnt < 0)
1904 1.18 mrg usb_detach_wakeupold(sc->sc_dev);
1905 1.1 scw
1906 1.1 scw return (err);
1907 1.1 scw }
1908