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