Home | History | Annotate | Line # | Download | only in ic
sl811hs.c revision 1.70
      1  1.70     skrll /*	$NetBSD: sl811hs.c,v 1.70 2016/05/14 10:07:52 skrll Exp $	*/
      2   1.1     isaki 
      3   1.1     isaki /*
      4  1.12  kiyohara  * Not (c) 2007 Matthew Orgass
      5  1.36     skrll  * This file is public domain, meaning anyone can make any use of part or all
      6  1.36     skrll  * of this file including copying into other works without credit.  Any use,
      7  1.36     skrll  * modified or not, is solely the responsibility of the user.  If this file is
      8  1.36     skrll  * part of a collection then use in the collection is governed by the terms of
      9  1.12  kiyohara  * the collection.
     10  1.12  kiyohara  */
     11  1.12  kiyohara 
     12  1.12  kiyohara /*
     13  1.12  kiyohara  * Cypress/ScanLogic SL811HS/T USB Host Controller
     14  1.12  kiyohara  * Datasheet, Errata, and App Note available at www.cypress.com
     15  1.12  kiyohara  *
     16  1.36     skrll  * Uses: Ratoc CFU1U PCMCIA USB Host Controller, Nereid X68k USB HC, ISA
     17  1.12  kiyohara  * HCs.  The Ratoc CFU2 uses a different chip.
     18   1.1     isaki  *
     19  1.36     skrll  * This chip puts the serial in USB.  It implements USB by means of an eight
     20  1.36     skrll  * bit I/O interface.  It can be used for ISA, PCMCIA/CF, parallel port,
     21  1.36     skrll  * serial port, or any eight bit interface.  It has 256 bytes of memory, the
     22  1.36     skrll  * first 16 of which are used for register access.  There are two sets of
     23  1.36     skrll  * registers for sending individual bus transactions.  Because USB is polled,
     24  1.36     skrll  * this organization means that some amount of card access must often be made
     25  1.36     skrll  * when devices are attached, even if when they are not directly being used.
     26  1.36     skrll  * A per-ms frame interrupt is necessary and many devices will poll with a
     27  1.12  kiyohara  * per-frame bulk transfer.
     28   1.1     isaki  *
     29  1.36     skrll  * It is possible to write a little over two bytes to the chip (auto
     30  1.36     skrll  * incremented) per full speed byte time on the USB.  Unfortunately,
     31  1.36     skrll  * auto-increment does not work reliably so write and bus speed is
     32  1.12  kiyohara  * approximately the same for full speed devices.
     33  1.12  kiyohara  *
     34  1.36     skrll  * In addition to the 240 byte packet size limit for isochronous transfers,
     35  1.36     skrll  * this chip has no means of determining the current frame number other than
     36  1.36     skrll  * getting all 1ms SOF interrupts, which is not always possible even on a fast
     37  1.36     skrll  * system.  Isochronous transfers guarantee that transfers will never be
     38  1.36     skrll  * retried in a later frame, so this can cause problems with devices beyond
     39  1.36     skrll  * the difficulty in actually performing the transfer most frames.  I tried
     40  1.36     skrll  * implementing isoc transfers and was able to play CD-derrived audio via an
     41  1.12  kiyohara  * iMic on a 2GHz PC, however it would still be interrupted at times and
     42  1.36     skrll  * once interrupted, would stay out of sync.  All isoc support has been
     43  1.12  kiyohara  * removed.
     44  1.12  kiyohara  *
     45  1.36     skrll  * BUGS: all chip revisions have problems with low speed devices through hubs.
     46  1.36     skrll  * The chip stops generating SOF with hubs that send SE0 during SOF.  See
     47  1.36     skrll  * comment in dointr().  All performance enhancing features of this chip seem
     48  1.12  kiyohara  * not to work properly, most confirmed buggy in errata doc.
     49   1.1     isaki  *
     50   1.1     isaki  */
     51   1.1     isaki 
     52   1.1     isaki /*
     53  1.36     skrll  * The hard interrupt is the main entry point.  Start, callbacks, and repeat
     54  1.12  kiyohara  * are the only others called frequently.
     55  1.12  kiyohara  *
     56  1.36     skrll  * Since this driver attaches to pcmcia, card removal at any point should be
     57  1.12  kiyohara  * expected and not cause panics or infinite loops.
     58   1.1     isaki  */
     59  1.12  kiyohara 
     60  1.34     skrll /*
     61  1.34     skrll  * XXX TODO:
     62  1.12  kiyohara  *   copy next output packet while transfering
     63  1.12  kiyohara  *   usb suspend
     64  1.12  kiyohara  *   could keep track of known values of all buffer space?
     65  1.12  kiyohara  *   combined print/log function for errors
     66  1.12  kiyohara  *
     67  1.48     skrll  *   ub_usepolling support is untested and may not work
     68   1.1     isaki  */
     69   1.1     isaki 
     70   1.1     isaki #include <sys/cdefs.h>
     71  1.70     skrll __KERNEL_RCSID(0, "$NetBSD: sl811hs.c,v 1.70 2016/05/14 10:07:52 skrll Exp $");
     72  1.26     isaki 
     73  1.26     isaki #include "opt_slhci.h"
     74   1.1     isaki 
     75  1.56     skrll #ifdef _KERNEL_OPT
     76  1.56     skrll #include "opt_usb.h"
     77  1.56     skrll #endif
     78  1.56     skrll 
     79   1.1     isaki #include <sys/param.h>
     80  1.56     skrll 
     81  1.53     skrll #include <sys/bus.h>
     82  1.53     skrll #include <sys/cpu.h>
     83  1.53     skrll #include <sys/device.h>
     84  1.53     skrll #include <sys/gcq.h>
     85  1.53     skrll #include <sys/intr.h>
     86   1.1     isaki #include <sys/kernel.h>
     87  1.53     skrll #include <sys/kmem.h>
     88   1.1     isaki #include <sys/proc.h>
     89  1.12  kiyohara #include <sys/queue.h>
     90  1.56     skrll #include <sys/sysctl.h>
     91  1.53     skrll #include <sys/systm.h>
     92   1.1     isaki 
     93   1.1     isaki #include <dev/usb/usb.h>
     94   1.1     isaki #include <dev/usb/usbdi.h>
     95   1.1     isaki #include <dev/usb/usbdivar.h>
     96  1.56     skrll #include <dev/usb/usbhist.h>
     97   1.1     isaki #include <dev/usb/usb_mem.h>
     98   1.1     isaki #include <dev/usb/usbdevs.h>
     99  1.48     skrll #include <dev/usb/usbroothub.h>
    100   1.1     isaki 
    101   1.1     isaki #include <dev/ic/sl811hsreg.h>
    102   1.1     isaki #include <dev/ic/sl811hsvar.h>
    103   1.1     isaki 
    104  1.12  kiyohara #define Q_CB 0				/* Control/Bulk */
    105  1.12  kiyohara #define Q_NEXT_CB 1
    106  1.12  kiyohara #define Q_MAX_XFER Q_CB
    107  1.12  kiyohara #define Q_CALLBACKS 2
    108  1.12  kiyohara #define Q_MAX Q_CALLBACKS
    109  1.12  kiyohara 
    110  1.12  kiyohara #define F_AREADY		(0x00000001)
    111  1.12  kiyohara #define F_BREADY		(0x00000002)
    112  1.12  kiyohara #define F_AINPROG		(0x00000004)
    113  1.12  kiyohara #define F_BINPROG		(0x00000008)
    114  1.12  kiyohara #define F_LOWSPEED		(0x00000010)
    115  1.12  kiyohara #define F_UDISABLED		(0x00000020) /* Consider disabled for USB */
    116  1.12  kiyohara #define F_NODEV			(0x00000040)
    117  1.12  kiyohara #define F_ROOTINTR		(0x00000080)
    118  1.12  kiyohara #define F_REALPOWER		(0x00000100) /* Actual power state */
    119  1.12  kiyohara #define F_POWER			(0x00000200) /* USB reported power state */
    120  1.12  kiyohara #define F_ACTIVE		(0x00000400)
    121  1.12  kiyohara #define F_CALLBACK		(0x00000800) /* Callback scheduled */
    122  1.12  kiyohara #define F_SOFCHECK1		(0x00001000)
    123  1.12  kiyohara #define F_SOFCHECK2		(0x00002000)
    124  1.12  kiyohara #define F_CRESET		(0x00004000) /* Reset done not reported */
    125  1.12  kiyohara #define F_CCONNECT		(0x00008000) /* Connect change not reported */
    126  1.12  kiyohara #define F_RESET			(0x00010000)
    127  1.12  kiyohara #define F_ISOC_WARNED		(0x00020000)
    128  1.12  kiyohara #define F_LSVH_WARNED		(0x00040000)
    129  1.12  kiyohara 
    130  1.12  kiyohara #define F_DISABLED		(F_NODEV|F_UDISABLED)
    131  1.12  kiyohara #define F_CHANGE		(F_CRESET|F_CCONNECT)
    132  1.12  kiyohara 
    133  1.12  kiyohara #ifdef SLHCI_TRY_LSVH
    134  1.12  kiyohara unsigned int slhci_try_lsvh = 1;
    135  1.12  kiyohara #else
    136  1.12  kiyohara unsigned int slhci_try_lsvh = 0;
    137  1.12  kiyohara #endif
    138  1.12  kiyohara 
    139  1.12  kiyohara #define ADR 0
    140  1.12  kiyohara #define LEN 1
    141  1.12  kiyohara #define PID 2
    142  1.12  kiyohara #define DEV 3
    143  1.12  kiyohara #define STAT 2
    144  1.12  kiyohara #define CONT 3
    145  1.12  kiyohara 
    146  1.12  kiyohara #define A 0
    147  1.12  kiyohara #define B 1
    148  1.12  kiyohara 
    149  1.36     skrll static const uint8_t slhci_tregs[2][4] =
    150  1.12  kiyohara {{SL11_E0ADDR, SL11_E0LEN, SL11_E0PID, SL11_E0DEV },
    151  1.12  kiyohara  {SL11_E1ADDR, SL11_E1LEN, SL11_E1PID, SL11_E1DEV }};
    152  1.12  kiyohara 
    153  1.12  kiyohara #define PT_ROOT_CTRL	0
    154  1.12  kiyohara #define PT_ROOT_INTR	1
    155  1.12  kiyohara #define PT_CTRL_SETUP	2
    156  1.12  kiyohara #define PT_CTRL_DATA	3
    157  1.12  kiyohara #define PT_CTRL_STATUS	4
    158  1.12  kiyohara #define PT_INTR		5
    159  1.12  kiyohara #define PT_BULK		6
    160  1.12  kiyohara #define PT_MAX		6
    161  1.12  kiyohara 
    162  1.12  kiyohara #ifdef SLHCI_DEBUG
    163  1.12  kiyohara #define SLHCI_MEM_ACCOUNTING
    164  1.12  kiyohara static const char *
    165  1.12  kiyohara pnames(int ptype)
    166  1.12  kiyohara {
    167  1.36     skrll 	static const char * const names[] = { "ROOT Ctrl", "ROOT Intr",
    168  1.12  kiyohara 	    "Control (setup)", "Control (data)", "Control (status)",
    169  1.12  kiyohara 	    "Interrupt", "Bulk", "BAD PTYPE" };
    170  1.12  kiyohara 
    171  1.12  kiyohara 	KASSERT(sizeof(names) / sizeof(names[0]) == PT_MAX + 2);
    172  1.12  kiyohara 	if (ptype > PT_MAX)
    173  1.12  kiyohara 		ptype = PT_MAX + 1;
    174  1.12  kiyohara 	return names[ptype];
    175  1.12  kiyohara }
    176  1.12  kiyohara #endif
    177  1.12  kiyohara 
    178  1.34     skrll /*
    179  1.34     skrll  * Maximum allowable reserved bus time.  Since intr/isoc transfers have
    180  1.37     skrll  * unconditional priority, this is all that ensures control and bulk transfers
    181  1.37     skrll  * get a chance.  It is a single value for all frames since all transfers can
    182  1.37     skrll  * use multiple consecutive frames if an error is encountered.  Note that it
    183  1.37     skrll  * is not really possible to fill the bus with transfers, so this value should
    184  1.37     skrll  * be on the low side.  Defaults to giving a warning unless SLHCI_NO_OVERTIME
    185  1.34     skrll  * is defined.  Full time is 12000 - END_BUSTIME.
    186  1.34     skrll  */
    187  1.12  kiyohara #ifndef SLHCI_RESERVED_BUSTIME
    188  1.12  kiyohara #define SLHCI_RESERVED_BUSTIME 5000
    189  1.12  kiyohara #endif
    190  1.12  kiyohara 
    191  1.34     skrll /*
    192  1.34     skrll  * Rate for "exceeds reserved bus time" warnings (default) or errors.
    193  1.37     skrll  * Warnings only happen when an endpoint open causes the time to go above
    194  1.34     skrll  * SLHCI_RESERVED_BUSTIME, not if it is already above.
    195  1.34     skrll  */
    196  1.12  kiyohara #ifndef SLHCI_OVERTIME_WARNING_RATE
    197  1.12  kiyohara #define SLHCI_OVERTIME_WARNING_RATE { 60, 0 } /* 60 seconds */
    198  1.12  kiyohara #endif
    199  1.12  kiyohara static const struct timeval reserved_warn_rate = SLHCI_OVERTIME_WARNING_RATE;
    200  1.12  kiyohara 
    201  1.12  kiyohara /* Rate for overflow warnings */
    202  1.12  kiyohara #ifndef SLHCI_OVERFLOW_WARNING_RATE
    203  1.12  kiyohara #define SLHCI_OVERFLOW_WARNING_RATE { 60, 0 } /* 60 seconds */
    204  1.12  kiyohara #endif
    205  1.12  kiyohara static const struct timeval overflow_warn_rate = SLHCI_OVERFLOW_WARNING_RATE;
    206  1.12  kiyohara 
    207  1.34     skrll /*
    208  1.34     skrll  * For EOF, the spec says 42 bit times, plus (I think) a possible hub skew of
    209  1.12  kiyohara  * 20 bit times.  By default leave 66 bit times to start the transfer beyond
    210  1.12  kiyohara  * the required time.  Units are full-speed bit times (a bit over 5us per 64).
    211  1.34     skrll  * Only multiples of 64 are significant.
    212  1.34     skrll  */
    213  1.12  kiyohara #define SLHCI_STANDARD_END_BUSTIME 128
    214  1.12  kiyohara #ifndef SLHCI_EXTRA_END_BUSTIME
    215  1.12  kiyohara #define SLHCI_EXTRA_END_BUSTIME 0
    216  1.12  kiyohara #endif
    217  1.12  kiyohara 
    218  1.12  kiyohara #define SLHCI_END_BUSTIME (SLHCI_STANDARD_END_BUSTIME+SLHCI_EXTRA_END_BUSTIME)
    219  1.12  kiyohara 
    220  1.34     skrll /*
    221  1.34     skrll  * This is an approximation of the USB worst-case timings presented on p. 54 of
    222  1.37     skrll  * the USB 1.1 spec translated to full speed bit times.
    223  1.37     skrll  * FS = full speed with handshake, FSII = isoc in, FSIO = isoc out,
    224  1.34     skrll  * FSI = isoc (worst case), LS = low speed
    225  1.34     skrll  */
    226  1.12  kiyohara #define SLHCI_FS_CONST		114
    227  1.12  kiyohara #define SLHCI_FSII_CONST	92
    228  1.12  kiyohara #define SLHCI_FSIO_CONST	80
    229  1.12  kiyohara #define SLHCI_FSI_CONST		92
    230  1.12  kiyohara #define SLHCI_LS_CONST		804
    231  1.12  kiyohara #ifndef SLHCI_PRECICE_BUSTIME
    232  1.34     skrll /*
    233  1.34     skrll  * These values are < 3% too high (compared to the multiply and divide) for
    234  1.34     skrll  * max sized packets.
    235  1.34     skrll  */
    236  1.12  kiyohara #define SLHCI_FS_DATA_TIME(len) (((u_int)(len)<<3)+(len)+((len)>>1))
    237  1.12  kiyohara #define SLHCI_LS_DATA_TIME(len) (((u_int)(len)<<6)+((u_int)(len)<<4))
    238  1.12  kiyohara #else
    239  1.12  kiyohara #define SLHCI_FS_DATA_TIME(len) (56*(len)/6)
    240  1.12  kiyohara #define SLHCI_LS_DATA_TIME(len) (449*(len)/6)
    241  1.12  kiyohara #endif
    242  1.12  kiyohara 
    243  1.34     skrll /*
    244  1.34     skrll  * Set SLHCI_WAIT_SIZE to the desired maximum size of single FS transfer
    245  1.12  kiyohara  * to poll for after starting a transfer.  64 gets all full speed transfers.
    246  1.36     skrll  * Note that even if 0 polling will occur if data equal or greater than the
    247  1.12  kiyohara  * transfer size is copied to the chip while the transfer is in progress.
    248  1.12  kiyohara  * Setting SLHCI_WAIT_TIME to -12000 will disable polling.
    249  1.12  kiyohara  */
    250  1.12  kiyohara #ifndef SLHCI_WAIT_SIZE
    251  1.12  kiyohara #define SLHCI_WAIT_SIZE 8
    252  1.12  kiyohara #endif
    253  1.12  kiyohara #ifndef SLHCI_WAIT_TIME
    254  1.12  kiyohara #define SLHCI_WAIT_TIME (SLHCI_FS_CONST + \
    255  1.12  kiyohara     SLHCI_FS_DATA_TIME(SLHCI_WAIT_SIZE))
    256  1.12  kiyohara #endif
    257  1.12  kiyohara const int slhci_wait_time = SLHCI_WAIT_TIME;
    258   1.1     isaki 
    259  1.12  kiyohara #ifndef SLHCI_MAX_RETRIES
    260  1.12  kiyohara #define SLHCI_MAX_RETRIES 3
    261  1.12  kiyohara #endif
    262   1.1     isaki 
    263  1.12  kiyohara /* Check IER values for corruption after this many unrecognized interrupts. */
    264  1.12  kiyohara #ifndef SLHCI_IER_CHECK_FREQUENCY
    265   1.1     isaki #ifdef SLHCI_DEBUG
    266  1.12  kiyohara #define SLHCI_IER_CHECK_FREQUENCY 1
    267   1.1     isaki #else
    268  1.12  kiyohara #define SLHCI_IER_CHECK_FREQUENCY 100
    269   1.1     isaki #endif
    270  1.12  kiyohara #endif
    271  1.12  kiyohara 
    272  1.12  kiyohara /* Note that buffer points to the start of the buffer for this transfer.  */
    273  1.12  kiyohara struct slhci_pipe {
    274  1.12  kiyohara 	struct usbd_pipe pipe;
    275  1.12  kiyohara 	struct usbd_xfer *xfer;		/* xfer in progress */
    276  1.12  kiyohara 	uint8_t		*buffer;	/* I/O buffer (if needed) */
    277  1.12  kiyohara 	struct gcq 	ap;		/* All pipes */
    278  1.12  kiyohara 	struct gcq 	to;		/* Timeout list */
    279  1.12  kiyohara 	struct gcq 	xq;		/* Xfer queues */
    280  1.12  kiyohara 	unsigned int	pflags;		/* Pipe flags */
    281  1.12  kiyohara #define PF_GONE		(0x01)		/* Pipe is on disabled device */
    282  1.12  kiyohara #define PF_TOGGLE 	(0x02)		/* Data toggle status */
    283  1.12  kiyohara #define PF_LS		(0x04)		/* Pipe is low speed */
    284  1.12  kiyohara #define PF_PREAMBLE	(0x08)		/* Needs preamble */
    285  1.12  kiyohara 	Frame		to_frame;	/* Frame number for timeout */
    286  1.12  kiyohara 	Frame		frame;		/* Frame number for intr xfer */
    287  1.12  kiyohara 	Frame		lastframe;	/* Previous frame number for intr */
    288  1.12  kiyohara 	uint16_t	bustime;	/* Worst case bus time usage */
    289  1.12  kiyohara 	uint16_t	newbustime[2];	/* new bustimes (see index below) */
    290  1.12  kiyohara 	uint8_t		tregs[4];	/* ADR, LEN, PID, DEV */
    291  1.12  kiyohara 	uint8_t		newlen[2];	/* 0 = short data, 1 = ctrl data */
    292  1.12  kiyohara 	uint8_t		newpid;		/* for ctrl */
    293  1.12  kiyohara 	uint8_t		wantshort;	/* last xfer must be short */
    294  1.12  kiyohara 	uint8_t		control;	/* Host control register settings */
    295  1.12  kiyohara 	uint8_t		nerrs;		/* Current number of errors */
    296  1.12  kiyohara 	uint8_t 	ptype;		/* Pipe type */
    297  1.12  kiyohara };
    298   1.1     isaki 
    299  1.48     skrll #define SLHCI_BUS2SC(bus)	((bus)->ub_hcpriv)
    300  1.48     skrll #define SLHCI_PIPE2SC(pipe)	SLHCI_BUS2SC((pipe)->up_dev->ud_bus)
    301  1.48     skrll #define SLHCI_XFER2SC(xfer)	SLHCI_BUS2SC((xfer)->ux_bus)
    302  1.48     skrll 
    303  1.48     skrll #define SLHCI_PIPE2SPIPE(pipe)	((struct slhci_pipe *)(pipe))
    304  1.55     skrll #define SLHCI_XFER2SPIPE(xfer)	SLHCI_PIPE2SPIPE((xfer)->ux_pipe)
    305  1.55     skrll 
    306  1.55     skrll #define SLHCI_XFER_TYPE(x)	(SLHCI_XFER2SPIPE(xfer)->ptype)
    307  1.48     skrll 
    308  1.12  kiyohara #ifdef SLHCI_PROFILE_TRANSFER
    309  1.12  kiyohara #if defined(__mips__)
    310  1.34     skrll /*
    311  1.34     skrll  * MIPS cycle counter does not directly count cpu cycles but is a different
    312  1.34     skrll  * fraction of cpu cycles depending on the cpu.
    313  1.34     skrll  */
    314  1.48     skrll typedef uint32_t cc_type;
    315  1.12  kiyohara #define CC_TYPE_FMT "%u"
    316  1.12  kiyohara #define slhci_cc_set(x) __asm volatile ("mfc0 %[cc], $9\n\tnop\n\tnop\n\tnop" \
    317  1.12  kiyohara     : [cc] "=r"(x))
    318  1.12  kiyohara #elif defined(__i386__)
    319  1.48     skrll typedef uint64_t cc_type;
    320  1.12  kiyohara #define CC_TYPE_FMT "%llu"
    321  1.12  kiyohara #define slhci_cc_set(x) __asm volatile ("rdtsc" : "=A"(x))
    322  1.12  kiyohara #else
    323  1.12  kiyohara #error "SLHCI_PROFILE_TRANSFER not implemented on this MACHINE_ARCH (see sys/dev/ic/sl811hs.c)"
    324  1.12  kiyohara #endif
    325  1.12  kiyohara struct slhci_cc_time {
    326  1.12  kiyohara 	cc_type start;
    327  1.12  kiyohara 	cc_type stop;
    328  1.12  kiyohara 	unsigned int miscdata;
    329  1.12  kiyohara };
    330  1.12  kiyohara #ifndef SLHCI_N_TIMES
    331  1.12  kiyohara #define SLHCI_N_TIMES 200
    332  1.12  kiyohara #endif
    333  1.12  kiyohara struct slhci_cc_times {
    334  1.12  kiyohara 	struct slhci_cc_time times[SLHCI_N_TIMES];
    335  1.12  kiyohara 	int current;
    336  1.12  kiyohara 	int wraparound;
    337   1.1     isaki };
    338   1.1     isaki 
    339  1.12  kiyohara static struct slhci_cc_times t_ab[2];
    340  1.12  kiyohara static struct slhci_cc_times t_abdone;
    341  1.12  kiyohara static struct slhci_cc_times t_copy_to_dev;
    342  1.12  kiyohara static struct slhci_cc_times t_copy_from_dev;
    343  1.12  kiyohara static struct slhci_cc_times t_intr;
    344  1.12  kiyohara static struct slhci_cc_times t_lock;
    345  1.12  kiyohara static struct slhci_cc_times t_delay;
    346  1.12  kiyohara static struct slhci_cc_times t_hard_int;
    347  1.12  kiyohara static struct slhci_cc_times t_callback;
    348  1.12  kiyohara 
    349  1.12  kiyohara static inline void
    350  1.12  kiyohara start_cc_time(struct slhci_cc_times *times, unsigned int misc) {
    351  1.12  kiyohara 	times->times[times->current].miscdata = misc;
    352  1.12  kiyohara 	slhci_cc_set(times->times[times->current].start);
    353  1.12  kiyohara }
    354  1.12  kiyohara static inline void
    355  1.12  kiyohara stop_cc_time(struct slhci_cc_times *times) {
    356  1.12  kiyohara 	slhci_cc_set(times->times[times->current].stop);
    357  1.12  kiyohara 	if (++times->current >= SLHCI_N_TIMES) {
    358  1.12  kiyohara 		times->current = 0;
    359  1.12  kiyohara 		times->wraparound = 1;
    360  1.12  kiyohara 	}
    361  1.12  kiyohara }
    362  1.12  kiyohara 
    363  1.12  kiyohara void slhci_dump_cc_times(int);
    364  1.12  kiyohara 
    365  1.12  kiyohara void
    366  1.12  kiyohara slhci_dump_cc_times(int n) {
    367  1.12  kiyohara 	struct slhci_cc_times *times;
    368  1.12  kiyohara 	int i;
    369  1.12  kiyohara 
    370  1.12  kiyohara 	switch (n) {
    371  1.12  kiyohara 	default:
    372  1.12  kiyohara 	case 0:
    373  1.12  kiyohara 		printf("USBA start transfer to intr:\n");
    374  1.12  kiyohara 		times = &t_ab[A];
    375  1.12  kiyohara 		break;
    376  1.12  kiyohara 	case 1:
    377  1.12  kiyohara 		printf("USBB start transfer to intr:\n");
    378  1.12  kiyohara 		times = &t_ab[B];
    379  1.12  kiyohara 		break;
    380  1.12  kiyohara 	case 2:
    381  1.12  kiyohara 		printf("abdone:\n");
    382  1.12  kiyohara 		times = &t_abdone;
    383  1.12  kiyohara 		break;
    384  1.12  kiyohara 	case 3:
    385  1.12  kiyohara 		printf("copy to device:\n");
    386  1.12  kiyohara 		times = &t_copy_to_dev;
    387  1.12  kiyohara 		break;
    388  1.12  kiyohara 	case 4:
    389  1.12  kiyohara 		printf("copy from device:\n");
    390  1.12  kiyohara 		times = &t_copy_from_dev;
    391  1.12  kiyohara 		break;
    392  1.12  kiyohara 	case 5:
    393  1.12  kiyohara 		printf("intr to intr:\n");
    394  1.12  kiyohara 		times = &t_intr;
    395  1.12  kiyohara 		break;
    396  1.12  kiyohara 	case 6:
    397  1.12  kiyohara 		printf("lock to release:\n");
    398  1.12  kiyohara 		times = &t_lock;
    399  1.12  kiyohara 		break;
    400  1.12  kiyohara 	case 7:
    401  1.12  kiyohara 		printf("delay time:\n");
    402  1.12  kiyohara 		times = &t_delay;
    403  1.12  kiyohara 		break;
    404  1.12  kiyohara 	case 8:
    405  1.12  kiyohara 		printf("hard interrupt enter to exit:\n");
    406  1.12  kiyohara 		times = &t_hard_int;
    407  1.12  kiyohara 		break;
    408  1.12  kiyohara 	case 9:
    409  1.12  kiyohara 		printf("callback:\n");
    410  1.12  kiyohara 		times = &t_callback;
    411  1.12  kiyohara 		break;
    412  1.12  kiyohara 	}
    413  1.12  kiyohara 
    414  1.12  kiyohara 	if (times->wraparound)
    415  1.12  kiyohara 		for (i = times->current + 1; i < SLHCI_N_TIMES; i++)
    416  1.36     skrll 			printf("start " CC_TYPE_FMT " stop " CC_TYPE_FMT
    417  1.36     skrll 			    " difference %8i miscdata %#x\n",
    418  1.36     skrll 			    times->times[i].start, times->times[i].stop,
    419  1.36     skrll 			    (int)(times->times[i].stop -
    420  1.12  kiyohara 			    times->times[i].start), times->times[i].miscdata);
    421  1.12  kiyohara 
    422  1.12  kiyohara 	for (i = 0; i < times->current; i++)
    423  1.36     skrll 		printf("start " CC_TYPE_FMT " stop " CC_TYPE_FMT
    424  1.36     skrll 		    " difference %8i miscdata %#x\n", times->times[i].start,
    425  1.36     skrll 		    times->times[i].stop, (int)(times->times[i].stop -
    426  1.12  kiyohara 		    times->times[i].start), times->times[i].miscdata);
    427  1.12  kiyohara }
    428  1.12  kiyohara #else
    429  1.12  kiyohara #define start_cc_time(x, y)
    430  1.12  kiyohara #define stop_cc_time(x)
    431  1.12  kiyohara #endif /* SLHCI_PROFILE_TRANSFER */
    432  1.12  kiyohara 
    433  1.36     skrll typedef usbd_status (*LockCallFunc)(struct slhci_softc *, struct slhci_pipe
    434  1.12  kiyohara     *, struct usbd_xfer *);
    435  1.12  kiyohara 
    436  1.48     skrll struct usbd_xfer * slhci_allocx(struct usbd_bus *, unsigned int);
    437  1.12  kiyohara void slhci_freex(struct usbd_bus *, struct usbd_xfer *);
    438  1.41     skrll static void slhci_get_lock(struct usbd_bus *, kmutex_t **);
    439  1.12  kiyohara 
    440  1.12  kiyohara usbd_status slhci_transfer(struct usbd_xfer *);
    441  1.12  kiyohara usbd_status slhci_start(struct usbd_xfer *);
    442  1.12  kiyohara usbd_status slhci_root_start(struct usbd_xfer *);
    443  1.12  kiyohara usbd_status slhci_open(struct usbd_pipe *);
    444  1.12  kiyohara 
    445  1.48     skrll static int slhci_roothub_ctrl(struct usbd_bus *, usb_device_request_t *,
    446  1.48     skrll     void *, int);
    447  1.48     skrll 
    448  1.34     skrll /*
    449  1.34     skrll  * slhci_supported_rev, slhci_preinit, slhci_attach, slhci_detach,
    450  1.34     skrll  * slhci_activate
    451  1.34     skrll  */
    452  1.12  kiyohara 
    453  1.12  kiyohara void slhci_abort(struct usbd_xfer *);
    454  1.12  kiyohara void slhci_close(struct usbd_pipe *);
    455  1.12  kiyohara void slhci_clear_toggle(struct usbd_pipe *);
    456  1.12  kiyohara void slhci_poll(struct usbd_bus *);
    457  1.12  kiyohara void slhci_done(struct usbd_xfer *);
    458  1.12  kiyohara void slhci_void(void *);
    459  1.12  kiyohara 
    460  1.12  kiyohara /* lock entry functions */
    461  1.12  kiyohara 
    462  1.12  kiyohara #ifdef SLHCI_MEM_ACCOUNTING
    463  1.12  kiyohara void slhci_mem_use(struct usbd_bus *, int);
    464  1.12  kiyohara #endif
    465  1.12  kiyohara 
    466  1.12  kiyohara void slhci_reset_entry(void *);
    467  1.36     skrll usbd_status slhci_lock_call(struct slhci_softc *, LockCallFunc,
    468  1.12  kiyohara     struct slhci_pipe *, struct usbd_xfer *);
    469  1.12  kiyohara void slhci_start_entry(struct slhci_softc *, struct slhci_pipe *);
    470  1.12  kiyohara void slhci_callback_entry(void *arg);
    471  1.41     skrll void slhci_do_callback(struct slhci_softc *, struct usbd_xfer *);
    472  1.12  kiyohara 
    473  1.12  kiyohara /* slhci_intr */
    474  1.12  kiyohara 
    475  1.41     skrll void slhci_main(struct slhci_softc *);
    476  1.12  kiyohara 
    477  1.12  kiyohara /* in lock functions */
    478  1.12  kiyohara 
    479  1.12  kiyohara static void slhci_write(struct slhci_softc *, uint8_t, uint8_t);
    480  1.12  kiyohara static uint8_t slhci_read(struct slhci_softc *, uint8_t);
    481  1.12  kiyohara static void slhci_write_multi(struct slhci_softc *, uint8_t, uint8_t *, int);
    482  1.12  kiyohara static void slhci_read_multi(struct slhci_softc *, uint8_t, uint8_t *, int);
    483  1.12  kiyohara 
    484  1.12  kiyohara static void slhci_waitintr(struct slhci_softc *, int);
    485  1.12  kiyohara static int slhci_dointr(struct slhci_softc *);
    486  1.12  kiyohara static void slhci_abdone(struct slhci_softc *, int);
    487  1.12  kiyohara static void slhci_tstart(struct slhci_softc *);
    488  1.12  kiyohara static void slhci_dotransfer(struct slhci_softc *);
    489  1.12  kiyohara 
    490  1.41     skrll static void slhci_callback(struct slhci_softc *);
    491  1.12  kiyohara static void slhci_enter_xfer(struct slhci_softc *, struct slhci_pipe *);
    492  1.12  kiyohara static void slhci_enter_xfers(struct slhci_softc *);
    493  1.12  kiyohara static void slhci_queue_timed(struct slhci_softc *, struct slhci_pipe *);
    494  1.12  kiyohara static void slhci_xfer_timer(struct slhci_softc *, struct slhci_pipe *);
    495  1.12  kiyohara 
    496  1.12  kiyohara static void slhci_callback_schedule(struct slhci_softc *);
    497  1.12  kiyohara static void slhci_do_callback_schedule(struct slhci_softc *);
    498  1.12  kiyohara #if 0
    499  1.41     skrll void slhci_pollxfer(struct slhci_softc *, struct usbd_xfer *); /* XXX */
    500  1.12  kiyohara #endif
    501  1.12  kiyohara 
    502  1.36     skrll static usbd_status slhci_do_poll(struct slhci_softc *, struct slhci_pipe *,
    503  1.12  kiyohara     struct usbd_xfer *);
    504  1.36     skrll static usbd_status slhci_lsvh_warn(struct slhci_softc *, struct slhci_pipe *,
    505  1.12  kiyohara     struct usbd_xfer *);
    506  1.36     skrll static usbd_status slhci_isoc_warn(struct slhci_softc *, struct slhci_pipe *,
    507  1.12  kiyohara     struct usbd_xfer *);
    508  1.36     skrll static usbd_status slhci_open_pipe(struct slhci_softc *, struct slhci_pipe *,
    509  1.12  kiyohara     struct usbd_xfer *);
    510  1.36     skrll static usbd_status slhci_close_pipe(struct slhci_softc *, struct slhci_pipe *,
    511  1.12  kiyohara     struct usbd_xfer *);
    512  1.36     skrll static usbd_status slhci_do_abort(struct slhci_softc *, struct slhci_pipe *,
    513  1.12  kiyohara     struct usbd_xfer *);
    514  1.36     skrll static usbd_status slhci_halt(struct slhci_softc *, struct slhci_pipe *,
    515  1.12  kiyohara     struct usbd_xfer *);
    516  1.12  kiyohara 
    517  1.12  kiyohara static void slhci_intrchange(struct slhci_softc *, uint8_t);
    518  1.12  kiyohara static void slhci_drain(struct slhci_softc *);
    519  1.12  kiyohara static void slhci_reset(struct slhci_softc *);
    520  1.36     skrll static int slhci_reserve_bustime(struct slhci_softc *, struct slhci_pipe *,
    521  1.12  kiyohara     int);
    522  1.12  kiyohara static void slhci_insert(struct slhci_softc *);
    523  1.12  kiyohara 
    524  1.12  kiyohara static usbd_status slhci_clear_feature(struct slhci_softc *, unsigned int);
    525  1.12  kiyohara static usbd_status slhci_set_feature(struct slhci_softc *, unsigned int);
    526  1.12  kiyohara static void slhci_get_status(struct slhci_softc *, usb_port_status_t *);
    527  1.36     skrll static usbd_status slhci_root(struct slhci_softc *, struct slhci_pipe *,
    528  1.12  kiyohara     struct usbd_xfer *);
    529  1.12  kiyohara 
    530  1.56     skrll #define	SLHCIHIST_FUNC()	USBHIST_FUNC()
    531  1.56     skrll #define	SLHCIHIST_CALLED()	USBHIST_CALLED(slhcidebug)
    532  1.56     skrll 
    533  1.12  kiyohara #ifdef SLHCI_DEBUG
    534  1.12  kiyohara void slhci_log_buffer(struct usbd_xfer *);
    535  1.12  kiyohara void slhci_log_req(usb_device_request_t *);
    536  1.12  kiyohara void slhci_log_req_hub(usb_device_request_t *);
    537  1.12  kiyohara void slhci_log_dumpreg(void);
    538  1.12  kiyohara void slhci_log_xfer(struct usbd_xfer *);
    539  1.12  kiyohara void slhci_log_spipe(struct slhci_pipe *);
    540  1.12  kiyohara void slhci_print_intr(void);
    541  1.12  kiyohara void slhci_log_sc(void);
    542  1.12  kiyohara void slhci_log_slreq(struct slhci_pipe *);
    543  1.12  kiyohara 
    544  1.12  kiyohara /* Constified so you can read the values from ddb */
    545  1.12  kiyohara const int SLHCI_D_TRACE =	0x0001;
    546  1.12  kiyohara const int SLHCI_D_MSG = 	0x0002;
    547  1.12  kiyohara const int SLHCI_D_XFER =	0x0004;
    548  1.12  kiyohara const int SLHCI_D_MEM = 	0x0008;
    549  1.12  kiyohara const int SLHCI_D_INTR =	0x0010;
    550  1.12  kiyohara const int SLHCI_D_SXFER =	0x0020;
    551  1.12  kiyohara const int SLHCI_D_ERR = 	0x0080;
    552  1.12  kiyohara const int SLHCI_D_BUF = 	0x0100;
    553  1.12  kiyohara const int SLHCI_D_SOFT =	0x0200;
    554  1.12  kiyohara const int SLHCI_D_WAIT =	0x0400;
    555  1.12  kiyohara const int SLHCI_D_ROOT =	0x0800;
    556  1.12  kiyohara /* SOF/NAK alone normally ignored, SOF also needs D_INTR */
    557  1.12  kiyohara const int SLHCI_D_SOF =		0x1000;
    558  1.12  kiyohara const int SLHCI_D_NAK =		0x2000;
    559  1.12  kiyohara 
    560  1.51     skrll int slhcidebug = 0x1cbc; /* 0xc8c; */ /* 0xffff; */ /* 0xd8c; */
    561  1.12  kiyohara 
    562  1.56     skrll SYSCTL_SETUP(sysctl_hw_slhci_setup, "sysctl hw.slhci setup")
    563  1.56     skrll {
    564  1.56     skrll 	int err;
    565  1.56     skrll 	const struct sysctlnode *rnode;
    566  1.56     skrll 	const struct sysctlnode *cnode;
    567  1.56     skrll 
    568  1.56     skrll 	err = sysctl_createv(clog, 0, NULL, &rnode,
    569  1.56     skrll 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "slhci",
    570  1.56     skrll 	    SYSCTL_DESCR("slhci global controls"),
    571  1.56     skrll 	    NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
    572  1.56     skrll 
    573  1.56     skrll 	if (err)
    574  1.56     skrll 		goto fail;
    575  1.56     skrll 
    576  1.56     skrll 	/* control debugging printfs */
    577  1.56     skrll 	err = sysctl_createv(clog, 0, &rnode, &cnode,
    578  1.56     skrll 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    579  1.56     skrll 	    "debug", SYSCTL_DESCR("Enable debugging output"),
    580  1.56     skrll 	    NULL, 0, &slhcidebug, sizeof(slhcidebug), CTL_CREATE, CTL_EOL);
    581  1.56     skrll 	if (err)
    582  1.56     skrll 		goto fail;
    583  1.56     skrll 
    584  1.56     skrll 	return;
    585  1.56     skrll fail:
    586  1.56     skrll 	aprint_error("%s: sysctl_createv failed (err = %d)\n", __func__, err);
    587  1.56     skrll }
    588  1.28       mrg 
    589  1.56     skrll struct slhci_softc *ssc;
    590  1.12  kiyohara 
    591  1.51     skrll #define SLHCI_DEXEC(x, y) do { if ((slhcidebug & SLHCI_ ## x)) { y; } \
    592  1.12  kiyohara } while (/*CONSTCOND*/ 0)
    593  1.56     skrll #define DDOLOG(f, a, b, c, d) do { KERNHIST_LOG(usbhist, f, a, b, c, d); \
    594  1.12  kiyohara } while (/*CONSTCOND*/0)
    595  1.12  kiyohara #define DLOG(x, f, a, b, c, d) SLHCI_DEXEC(x, DDOLOG(f, a, b, c, d))
    596  1.34     skrll /*
    597  1.34     skrll  * DLOGFLAG8 is a macro not a function so that flag name expressions are not
    598  1.37     skrll  * evaluated unless the flag bit is set (which could save a register read).
    599  1.37     skrll  * x is debug mask, y is flag identifier, z is flag variable,
    600  1.34     skrll  * a-h are flag names (must evaluate to string constants, msb first).
    601  1.34     skrll  */
    602  1.12  kiyohara #define DDOLOGFLAG8(y, z, a, b, c, d, e, f, g, h) do { uint8_t _DLF8 = (z);   \
    603  1.56     skrll     if (_DLF8 & 0xf0) KERNHIST_LOG(usbhist, y " %s %s %s %s", _DLF8 & 0x80 ?  \
    604  1.12  kiyohara     (a) : "", _DLF8 & 0x40 ? (b) : "", _DLF8 & 0x20 ? (c) : "", _DLF8 & 0x10 ? \
    605  1.56     skrll     (d) : ""); if (_DLF8 & 0x0f) KERNHIST_LOG(usbhist, y " %s %s %s %s",      \
    606  1.12  kiyohara     _DLF8 & 0x08 ? (e) : "", _DLF8 & 0x04 ? (f) : "", _DLF8 & 0x02 ? (g) : "", \
    607  1.12  kiyohara     _DLF8 & 0x01 ? (h) : "");		      				       \
    608  1.12  kiyohara } while (/*CONSTCOND*/ 0)
    609  1.12  kiyohara #define DLOGFLAG8(x, y, z, a, b, c, d, e, f, g, h) \
    610  1.12  kiyohara     SLHCI_DEXEC(x, DDOLOGFLAG8(y, z, a, b, c, d, e, f, g, h))
    611  1.34     skrll /*
    612  1.34     skrll  * DDOLOGBUF logs a buffer up to 8 bytes at a time. No identifier so that we
    613  1.34     skrll  * can make it a real function.
    614  1.34     skrll  */
    615  1.12  kiyohara static void
    616  1.12  kiyohara DDOLOGBUF(uint8_t *buf, unsigned int length)
    617  1.12  kiyohara {
    618  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    619  1.12  kiyohara 	int i;
    620  1.12  kiyohara 
    621  1.12  kiyohara 	for(i=0; i+8 <= length; i+=8)
    622  1.12  kiyohara 		DDOLOG("%.4x %.4x %.4x %.4x", (buf[i] << 8) | buf[i+1],
    623  1.12  kiyohara 		    (buf[i+2] << 8) | buf[i+3], (buf[i+4] << 8) | buf[i+5],
    624  1.12  kiyohara 		    (buf[i+6] << 8) | buf[i+7]);
    625  1.12  kiyohara 	if (length == i+7)
    626  1.12  kiyohara 		DDOLOG("%.4x %.4x %.4x %.2x", (buf[i] << 8) | buf[i+1],
    627  1.12  kiyohara 		    (buf[i+2] << 8) | buf[i+3], (buf[i+4] << 8) | buf[i+5],
    628  1.12  kiyohara 		    buf[i+6]);
    629  1.12  kiyohara 	else if (length == i+6)
    630  1.12  kiyohara 		DDOLOG("%.4x %.4x %.4x", (buf[i] << 8) | buf[i+1],
    631  1.12  kiyohara 		    (buf[i+2] << 8) | buf[i+3], (buf[i+4] << 8) | buf[i+5], 0);
    632  1.12  kiyohara 	else if (length == i+5)
    633  1.12  kiyohara 		DDOLOG("%.4x %.4x %.2x", (buf[i] << 8) | buf[i+1],
    634  1.12  kiyohara 		    (buf[i+2] << 8) | buf[i+3], buf[i+4], 0);
    635  1.12  kiyohara 	else if (length == i+4)
    636  1.12  kiyohara 		DDOLOG("%.4x %.4x", (buf[i] << 8) | buf[i+1],
    637  1.12  kiyohara 		    (buf[i+2] << 8) | buf[i+3], 0,0);
    638  1.12  kiyohara 	else if (length == i+3)
    639  1.12  kiyohara 		DDOLOG("%.4x %.2x", (buf[i] << 8) | buf[i+1], buf[i+2], 0,0);
    640  1.12  kiyohara 	else if (length == i+2)
    641  1.12  kiyohara 		DDOLOG("%.4x", (buf[i] << 8) | buf[i+1], 0,0,0);
    642  1.12  kiyohara 	else if (length == i+1)
    643  1.12  kiyohara 		DDOLOG("%.2x", buf[i], 0,0,0);
    644  1.12  kiyohara }
    645  1.12  kiyohara #define DLOGBUF(x, b, l) SLHCI_DEXEC(x, DDOLOGBUF(b, l))
    646  1.12  kiyohara #else /* now !SLHCI_DEBUG */
    647  1.56     skrll #define slhcidebug 0
    648  1.12  kiyohara #define slhci_log_spipe(spipe) ((void)0)
    649  1.12  kiyohara #define slhci_log_xfer(xfer) ((void)0)
    650  1.12  kiyohara #define SLHCI_DEXEC(x, y) ((void)0)
    651  1.12  kiyohara #define DDOLOG(f, a, b, c, d) ((void)0)
    652  1.12  kiyohara #define DLOG(x, f, a, b, c, d) ((void)0)
    653  1.12  kiyohara #define DDOLOGFLAG8(y, z, a, b, c, d, e, f, g, h) ((void)0)
    654  1.12  kiyohara #define DLOGFLAG8(x, y, z, a, b, c, d, e, f, g, h) ((void)0)
    655  1.12  kiyohara #define DDOLOGBUF(b, l) ((void)0)
    656  1.12  kiyohara #define DLOGBUF(x, b, l) ((void)0)
    657  1.12  kiyohara #endif /* SLHCI_DEBUG */
    658  1.12  kiyohara 
    659  1.12  kiyohara #ifdef DIAGNOSTIC
    660  1.12  kiyohara #define LK_SLASSERT(exp, sc, spipe, xfer, ext) do {			\
    661  1.12  kiyohara 	if (!(exp)) {							\
    662  1.12  kiyohara 		printf("%s: assertion %s failed line %u function %s!"	\
    663  1.12  kiyohara 		" halted\n", SC_NAME(sc), #exp, __LINE__, __func__);\
    664  1.12  kiyohara 		DDOLOG("%s: assertion %s failed line %u function %s!"	\
    665  1.12  kiyohara 		" halted\n", SC_NAME(sc), #exp, __LINE__, __func__);\
    666  1.12  kiyohara 		slhci_halt(sc, spipe, xfer);				\
    667  1.12  kiyohara 		ext;							\
    668  1.12  kiyohara 	}								\
    669  1.12  kiyohara } while (/*CONSTCOND*/0)
    670  1.12  kiyohara #define UL_SLASSERT(exp, sc, spipe, xfer, ext) do {			\
    671  1.12  kiyohara 	if (!(exp)) {							\
    672  1.12  kiyohara 		printf("%s: assertion %s failed line %u function %s!"	\
    673  1.12  kiyohara 		" halted\n", SC_NAME(sc), #exp, __LINE__, __func__);	\
    674  1.12  kiyohara 		DDOLOG("%s: assertion %s failed line %u function %s!"	\
    675  1.12  kiyohara 		" halted\n", SC_NAME(sc), #exp, __LINE__, __func__);	\
    676  1.12  kiyohara 		slhci_lock_call(sc, &slhci_halt, spipe, xfer);		\
    677  1.12  kiyohara 		ext;							\
    678  1.12  kiyohara 	}								\
    679  1.12  kiyohara } while (/*CONSTCOND*/0)
    680  1.12  kiyohara #else
    681  1.12  kiyohara #define LK_SLASSERT(exp, sc, spipe, xfer, ext) ((void)0)
    682  1.12  kiyohara #define UL_SLASSERT(exp, sc, spipe, xfer, ext) ((void)0)
    683  1.12  kiyohara #endif
    684  1.12  kiyohara 
    685  1.12  kiyohara const struct usbd_bus_methods slhci_bus_methods = {
    686  1.48     skrll 	.ubm_open = slhci_open,
    687  1.48     skrll 	.ubm_softint= slhci_void,
    688  1.48     skrll 	.ubm_dopoll = slhci_poll,
    689  1.48     skrll 	.ubm_allocx = slhci_allocx,
    690  1.48     skrll 	.ubm_freex = slhci_freex,
    691  1.48     skrll 	.ubm_getlock = slhci_get_lock,
    692  1.48     skrll 	.ubm_rhctrl = slhci_roothub_ctrl,
    693   1.1     isaki };
    694   1.1     isaki 
    695  1.12  kiyohara const struct usbd_pipe_methods slhci_pipe_methods = {
    696  1.48     skrll 	.upm_transfer = slhci_transfer,
    697  1.48     skrll 	.upm_start = slhci_start,
    698  1.48     skrll 	.upm_abort = slhci_abort,
    699  1.48     skrll 	.upm_close = slhci_close,
    700  1.48     skrll 	.upm_cleartoggle = slhci_clear_toggle,
    701  1.48     skrll 	.upm_done = slhci_done,
    702   1.1     isaki };
    703   1.1     isaki 
    704  1.12  kiyohara const struct usbd_pipe_methods slhci_root_methods = {
    705  1.48     skrll 	.upm_transfer = slhci_transfer,
    706  1.48     skrll 	.upm_start = slhci_root_start,
    707  1.48     skrll 	.upm_abort = slhci_abort,
    708  1.48     skrll 	.upm_close = (void (*)(struct usbd_pipe *))slhci_void, /* XXX safe? */
    709  1.48     skrll 	.upm_cleartoggle = slhci_clear_toggle,
    710  1.48     skrll 	.upm_done = slhci_done,
    711   1.1     isaki };
    712   1.1     isaki 
    713  1.12  kiyohara /* Queue inlines */
    714  1.12  kiyohara 
    715  1.12  kiyohara #define GOT_FIRST_TO(tvar, t) \
    716  1.12  kiyohara     GCQ_GOT_FIRST_TYPED(tvar, &(t)->to, struct slhci_pipe, to)
    717  1.12  kiyohara 
    718  1.12  kiyohara #define FIND_TO(var, t, tvar, cond) \
    719  1.12  kiyohara     GCQ_FIND_TYPED(var, &(t)->to, tvar, struct slhci_pipe, to, cond)
    720  1.12  kiyohara 
    721  1.12  kiyohara #define FOREACH_AP(var, t, tvar) \
    722  1.12  kiyohara     GCQ_FOREACH_TYPED(var, &(t)->ap, tvar, struct slhci_pipe, ap)
    723   1.1     isaki 
    724  1.12  kiyohara #define GOT_FIRST_TIMED_COND(tvar, t, cond) \
    725  1.12  kiyohara     GCQ_GOT_FIRST_COND_TYPED(tvar, &(t)->timed, struct slhci_pipe, xq, cond)
    726   1.1     isaki 
    727  1.12  kiyohara #define GOT_FIRST_CB(tvar, t) \
    728  1.12  kiyohara     GCQ_GOT_FIRST_TYPED(tvar, &(t)->q[Q_CB], struct slhci_pipe, xq)
    729   1.1     isaki 
    730  1.12  kiyohara #define DEQUEUED_CALLBACK(tvar, t) \
    731  1.12  kiyohara     GCQ_DEQUEUED_FIRST_TYPED(tvar, &(t)->q[Q_CALLBACKS], struct slhci_pipe, xq)
    732   1.1     isaki 
    733  1.12  kiyohara #define FIND_TIMED(var, t, tvar, cond) \
    734  1.12  kiyohara    GCQ_FIND_TYPED(var, &(t)->timed, tvar, struct slhci_pipe, xq, cond)
    735   1.1     isaki 
    736  1.12  kiyohara #define DEQUEUED_WAITQ(tvar, sc) \
    737  1.12  kiyohara     GCQ_DEQUEUED_FIRST_TYPED(tvar, &(sc)->sc_waitq, struct slhci_pipe, xq)
    738   1.1     isaki 
    739  1.12  kiyohara static inline void
    740  1.12  kiyohara enter_waitq(struct slhci_softc *sc, struct slhci_pipe *spipe)
    741   1.1     isaki {
    742  1.12  kiyohara 	gcq_insert_tail(&sc->sc_waitq, &spipe->xq);
    743   1.1     isaki }
    744   1.1     isaki 
    745   1.1     isaki static inline void
    746  1.12  kiyohara enter_q(struct slhci_transfers *t, struct slhci_pipe *spipe, int i)
    747   1.1     isaki {
    748  1.12  kiyohara 	gcq_insert_tail(&t->q[i], &spipe->xq);
    749   1.1     isaki }
    750   1.1     isaki 
    751   1.1     isaki static inline void
    752  1.12  kiyohara enter_callback(struct slhci_transfers *t, struct slhci_pipe *spipe)
    753   1.1     isaki {
    754  1.12  kiyohara 	gcq_insert_tail(&t->q[Q_CALLBACKS], &spipe->xq);
    755   1.1     isaki }
    756   1.1     isaki 
    757   1.1     isaki static inline void
    758  1.12  kiyohara enter_all_pipes(struct slhci_transfers *t, struct slhci_pipe *spipe)
    759   1.1     isaki {
    760  1.12  kiyohara 	gcq_insert_tail(&t->ap, &spipe->ap);
    761   1.1     isaki }
    762   1.1     isaki 
    763  1.12  kiyohara /* Start out of lock functions. */
    764  1.12  kiyohara 
    765  1.12  kiyohara struct usbd_xfer *
    766  1.48     skrll slhci_allocx(struct usbd_bus *bus, unsigned int nframes)
    767   1.1     isaki {
    768  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    769  1.12  kiyohara 	struct usbd_xfer *xfer;
    770  1.12  kiyohara 
    771  1.48     skrll 	xfer = kmem_zalloc(sizeof(*xfer), KM_SLEEP);
    772   1.1     isaki 
    773  1.12  kiyohara 	DLOG(D_MEM, "allocx %p", xfer, 0,0,0);
    774  1.12  kiyohara 
    775  1.12  kiyohara #ifdef SLHCI_MEM_ACCOUNTING
    776  1.12  kiyohara 	slhci_mem_use(bus, 1);
    777  1.12  kiyohara #endif
    778  1.12  kiyohara #ifdef DIAGNOSTIC
    779  1.12  kiyohara 	if (xfer != NULL)
    780  1.48     skrll 		xfer->ux_state = XFER_BUSY;
    781  1.12  kiyohara #endif
    782  1.12  kiyohara 	return xfer;
    783  1.12  kiyohara }
    784  1.12  kiyohara 
    785  1.12  kiyohara void
    786  1.12  kiyohara slhci_freex(struct usbd_bus *bus, struct usbd_xfer *xfer)
    787  1.12  kiyohara {
    788  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    789  1.48     skrll 	DLOG(D_MEM, "freex xfer %p spipe %p", xfer, xfer->ux_pipe,0,0);
    790   1.1     isaki 
    791  1.12  kiyohara #ifdef SLHCI_MEM_ACCOUNTING
    792  1.12  kiyohara 	slhci_mem_use(bus, -1);
    793  1.12  kiyohara #endif
    794  1.12  kiyohara #ifdef DIAGNOSTIC
    795  1.48     skrll 	if (xfer->ux_state != XFER_BUSY) {
    796  1.48     skrll 		struct slhci_softc *sc = SLHCI_BUS2SC(bus);
    797  1.36     skrll 		printf("%s: slhci_freex: xfer=%p not busy, %#08x halted\n",
    798  1.48     skrll 		    SC_NAME(sc), xfer, xfer->ux_state);
    799  1.36     skrll 		DDOLOG("%s: slhci_freex: xfer=%p not busy, %#08x halted\n",
    800  1.48     skrll 		    SC_NAME(sc), xfer, xfer->ux_state, 0);
    801  1.12  kiyohara 		slhci_lock_call(sc, &slhci_halt, NULL, NULL);
    802  1.12  kiyohara 		return;
    803   1.1     isaki 	}
    804  1.48     skrll 	xfer->ux_state = XFER_FREE;
    805  1.12  kiyohara #endif
    806   1.1     isaki 
    807  1.48     skrll 	kmem_free(xfer, sizeof(*xfer));
    808  1.12  kiyohara }
    809   1.1     isaki 
    810  1.41     skrll static void
    811  1.41     skrll slhci_get_lock(struct usbd_bus *bus, kmutex_t **lock)
    812  1.41     skrll {
    813  1.48     skrll 	struct slhci_softc *sc = SLHCI_BUS2SC(bus);
    814  1.41     skrll 
    815  1.41     skrll 	*lock = &sc->sc_lock;
    816  1.41     skrll }
    817  1.41     skrll 
    818  1.12  kiyohara usbd_status
    819  1.12  kiyohara slhci_transfer(struct usbd_xfer *xfer)
    820  1.12  kiyohara {
    821  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    822  1.48     skrll 	struct slhci_softc *sc = SLHCI_XFER2SC(xfer);
    823  1.12  kiyohara 	usbd_status error;
    824   1.1     isaki 
    825  1.36     skrll 	DLOG(D_TRACE, "%s transfer xfer %p spipe %p ",
    826  1.48     skrll 	    pnames(SLHCI_XFER_TYPE(xfer)), xfer, xfer->ux_pipe,0);
    827   1.1     isaki 
    828  1.12  kiyohara 	/* Insert last in queue */
    829  1.41     skrll 	mutex_enter(&sc->sc_lock);
    830  1.12  kiyohara 	error = usb_insert_transfer(xfer);
    831  1.41     skrll 	mutex_exit(&sc->sc_lock);
    832  1.12  kiyohara 	if (error) {
    833  1.12  kiyohara 		if (error != USBD_IN_PROGRESS)
    834  1.36     skrll 			DLOG(D_ERR, "usb_insert_transfer returns %d!", error,
    835  1.12  kiyohara 			    0,0,0);
    836  1.12  kiyohara 		return error;
    837  1.12  kiyohara 	}
    838   1.1     isaki 
    839  1.12  kiyohara 	/*
    840  1.12  kiyohara 	 * Pipe isn't running (otherwise error would be USBD_INPROG),
    841  1.12  kiyohara 	 * so start it first.
    842  1.12  kiyohara 	 */
    843   1.1     isaki 
    844  1.34     skrll 	/*
    845  1.41     skrll 	 * Start will take the lock.
    846  1.34     skrll 	 */
    847  1.48     skrll 	error = xfer->ux_pipe->up_methods->upm_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
    848   1.1     isaki 
    849  1.12  kiyohara 	return error;
    850   1.1     isaki }
    851   1.1     isaki 
    852  1.12  kiyohara /* It is not safe for start to return anything other than USBD_INPROG. */
    853  1.12  kiyohara usbd_status
    854  1.12  kiyohara slhci_start(struct usbd_xfer *xfer)
    855   1.1     isaki {
    856  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    857  1.48     skrll 	struct slhci_softc *sc = SLHCI_XFER2SC(xfer);
    858  1.48     skrll 	struct usbd_pipe *pipe = xfer->ux_pipe;
    859  1.48     skrll 	struct slhci_pipe *spipe = SLHCI_PIPE2SPIPE(pipe);
    860  1.41     skrll 	struct slhci_transfers *t = &sc->sc_transfers;
    861  1.48     skrll 	usb_endpoint_descriptor_t *ed = pipe->up_endpoint->ue_edesc;
    862  1.12  kiyohara 	unsigned int max_packet;
    863  1.12  kiyohara 
    864  1.41     skrll 	mutex_enter(&sc->sc_lock);
    865  1.12  kiyohara 
    866  1.12  kiyohara 	max_packet = UGETW(ed->wMaxPacketSize);
    867  1.12  kiyohara 
    868  1.36     skrll 	DLOG(D_TRACE, "%s start xfer %p spipe %p length %d",
    869  1.48     skrll 	    pnames(spipe->ptype), xfer, spipe, xfer->ux_length);
    870  1.12  kiyohara 
    871  1.12  kiyohara 	/* root transfers use slhci_root_start */
    872  1.12  kiyohara 
    873  1.12  kiyohara 	KASSERT(spipe->xfer == NULL); /* not SLASSERT */
    874  1.12  kiyohara 
    875  1.48     skrll 	xfer->ux_actlen = 0;
    876  1.48     skrll 	xfer->ux_status = USBD_IN_PROGRESS;
    877  1.12  kiyohara 
    878  1.12  kiyohara 	spipe->xfer = xfer;
    879  1.12  kiyohara 
    880  1.12  kiyohara 	spipe->nerrs = 0;
    881  1.12  kiyohara 	spipe->frame = t->frame;
    882  1.12  kiyohara 	spipe->control = SL11_EPCTRL_ARM_ENABLE;
    883  1.48     skrll 	spipe->tregs[DEV] = pipe->up_dev->ud_addr;
    884  1.36     skrll 	spipe->tregs[PID] = spipe->newpid = UE_GET_ADDR(ed->bEndpointAddress)
    885  1.36     skrll 	    | (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN ? SL11_PID_IN :
    886  1.12  kiyohara 	    SL11_PID_OUT);
    887  1.48     skrll 	spipe->newlen[0] = xfer->ux_length % max_packet;
    888  1.48     skrll 	spipe->newlen[1] = min(xfer->ux_length, max_packet);
    889  1.12  kiyohara 
    890  1.12  kiyohara 	if (spipe->ptype == PT_BULK || spipe->ptype == PT_INTR) {
    891  1.12  kiyohara 		if (spipe->pflags & PF_TOGGLE)
    892  1.12  kiyohara 			spipe->control |= SL11_EPCTRL_DATATOGGLE;
    893  1.12  kiyohara 		spipe->tregs[LEN] = spipe->newlen[1];
    894  1.36     skrll 		if (spipe->tregs[LEN])
    895  1.48     skrll 			spipe->buffer = xfer->ux_buf;
    896  1.12  kiyohara 		else
    897  1.12  kiyohara 			spipe->buffer = NULL;
    898  1.12  kiyohara 		spipe->lastframe = t->frame;
    899  1.12  kiyohara #if defined(DEBUG) || defined(SLHCI_DEBUG)
    900  1.36     skrll 		if (__predict_false(spipe->ptype == PT_INTR &&
    901  1.48     skrll 		    xfer->ux_length > spipe->tregs[LEN])) {
    902  1.12  kiyohara 			printf("%s: Long INTR transfer not supported!\n",
    903  1.36     skrll 			    SC_NAME(sc));
    904  1.12  kiyohara 			DDOLOG("%s: Long INTR transfer not supported!\n",
    905  1.12  kiyohara 			    SC_NAME(sc), 0,0,0);
    906  1.48     skrll 			xfer->ux_status = USBD_INVAL;
    907  1.12  kiyohara 		}
    908   1.1     isaki #endif
    909  1.12  kiyohara 	} else {
    910  1.12  kiyohara 		/* ptype may be currently set to any control transfer type. */
    911  1.12  kiyohara 		SLHCI_DEXEC(D_TRACE, slhci_log_xfer(xfer));
    912   1.1     isaki 
    913  1.12  kiyohara 		/* SETUP contains IN/OUT bits also */
    914  1.12  kiyohara 		spipe->tregs[PID] |= SL11_PID_SETUP;
    915  1.12  kiyohara 		spipe->tregs[LEN] = 8;
    916  1.48     skrll 		spipe->buffer = (uint8_t *)&xfer->ux_request;
    917  1.12  kiyohara 		DLOGBUF(D_XFER, spipe->buffer, spipe->tregs[LEN]);
    918  1.12  kiyohara 		spipe->ptype = PT_CTRL_SETUP;
    919  1.12  kiyohara 		spipe->newpid &= ~SL11_PID_BITS;
    920  1.48     skrll 		if (xfer->ux_length == 0 || (xfer->ux_request.bmRequestType &
    921  1.12  kiyohara 		    UT_READ))
    922  1.12  kiyohara 			spipe->newpid |= SL11_PID_IN;
    923  1.12  kiyohara 		else
    924  1.12  kiyohara 			spipe->newpid |= SL11_PID_OUT;
    925  1.12  kiyohara 	}
    926  1.12  kiyohara 
    927  1.48     skrll 	if (xfer->ux_flags & USBD_FORCE_SHORT_XFER && spipe->tregs[LEN] ==
    928  1.12  kiyohara 	    max_packet && (spipe->newpid & SL11_PID_BITS) == SL11_PID_OUT)
    929  1.12  kiyohara 		spipe->wantshort = 1;
    930  1.12  kiyohara 	else
    931  1.12  kiyohara 		spipe->wantshort = 0;
    932  1.12  kiyohara 
    933  1.34     skrll 	/*
    934  1.34     skrll 	 * The goal of newbustime and newlen is to avoid bustime calculation
    935  1.37     skrll 	 * in the interrupt.  The calculations are not too complex, but they
    936  1.37     skrll 	 * complicate the conditional logic somewhat and doing them all in the
    937  1.37     skrll 	 * same place shares constants. Index 0 is "short length" for bulk and
    938  1.37     skrll 	 * ctrl data and 1 is "full length" for ctrl data (bulk/intr are
    939  1.34     skrll 	 * already set to full length).
    940  1.34     skrll 	 */
    941  1.12  kiyohara 	if (spipe->pflags & PF_LS) {
    942  1.34     skrll 		/*
    943  1.48     skrll 		 * Setting PREAMBLE for directly connected LS devices will
    944  1.34     skrll 		 * lock up the chip.
    945  1.34     skrll 		 */
    946  1.12  kiyohara 		if (spipe->pflags & PF_PREAMBLE)
    947  1.12  kiyohara 			spipe->control |= SL11_EPCTRL_PREAMBLE;
    948  1.12  kiyohara 		if (max_packet <= 8) {
    949  1.36     skrll 			spipe->bustime = SLHCI_LS_CONST +
    950  1.12  kiyohara 			    SLHCI_LS_DATA_TIME(spipe->tregs[LEN]);
    951  1.36     skrll 			spipe->newbustime[0] = SLHCI_LS_CONST +
    952  1.12  kiyohara 			    SLHCI_LS_DATA_TIME(spipe->newlen[0]);
    953  1.36     skrll 			spipe->newbustime[1] = SLHCI_LS_CONST +
    954  1.12  kiyohara 			    SLHCI_LS_DATA_TIME(spipe->newlen[1]);
    955  1.12  kiyohara 		} else
    956  1.48     skrll 			xfer->ux_status = USBD_INVAL;
    957  1.12  kiyohara 	} else {
    958  1.48     skrll 		UL_SLASSERT(pipe->up_dev->ud_speed == USB_SPEED_FULL, sc,
    959  1.12  kiyohara 		    spipe, xfer, return USBD_IN_PROGRESS);
    960  1.12  kiyohara 		if (max_packet <= SL11_MAX_PACKET_SIZE) {
    961  1.36     skrll 			spipe->bustime = SLHCI_FS_CONST +
    962  1.12  kiyohara 			    SLHCI_FS_DATA_TIME(spipe->tregs[LEN]);
    963  1.36     skrll 			spipe->newbustime[0] = SLHCI_FS_CONST +
    964  1.12  kiyohara 			    SLHCI_FS_DATA_TIME(spipe->newlen[0]);
    965  1.36     skrll 			spipe->newbustime[1] = SLHCI_FS_CONST +
    966  1.12  kiyohara 			    SLHCI_FS_DATA_TIME(spipe->newlen[1]);
    967  1.12  kiyohara 		} else
    968  1.48     skrll 			xfer->ux_status = USBD_INVAL;
    969  1.12  kiyohara 	}
    970  1.12  kiyohara 
    971  1.34     skrll 	/*
    972  1.34     skrll 	 * The datasheet incorrectly indicates that DIRECTION is for
    973  1.37     skrll 	 * "transmit to host".  It is for OUT and SETUP.  The app note
    974  1.34     skrll 	 * describes its use correctly.
    975  1.34     skrll 	 */
    976  1.37     skrll 	if ((spipe->tregs[PID] & SL11_PID_BITS) != SL11_PID_IN)
    977  1.12  kiyohara 		spipe->control |= SL11_EPCTRL_DIRECTION;
    978  1.12  kiyohara 
    979  1.12  kiyohara 	slhci_start_entry(sc, spipe);
    980   1.1     isaki 
    981  1.41     skrll 	mutex_exit(&sc->sc_lock);
    982  1.41     skrll 
    983  1.12  kiyohara 	return USBD_IN_PROGRESS;
    984  1.12  kiyohara }
    985   1.1     isaki 
    986  1.12  kiyohara usbd_status
    987  1.12  kiyohara slhci_root_start(struct usbd_xfer *xfer)
    988  1.12  kiyohara {
    989  1.58     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
    990  1.12  kiyohara 	struct slhci_softc *sc;
    991  1.12  kiyohara 	struct slhci_pipe *spipe;
    992   1.1     isaki 
    993  1.48     skrll 	spipe = SLHCI_PIPE2SPIPE(xfer->ux_pipe);
    994  1.48     skrll 	sc = SLHCI_XFER2SC(xfer);
    995   1.1     isaki 
    996  1.12  kiyohara 	return slhci_lock_call(sc, &slhci_root, spipe, xfer);
    997   1.1     isaki }
    998   1.1     isaki 
    999   1.1     isaki usbd_status
   1000  1.12  kiyohara slhci_open(struct usbd_pipe *pipe)
   1001   1.1     isaki {
   1002  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1003  1.12  kiyohara 	struct usbd_device *dev;
   1004  1.12  kiyohara 	struct slhci_softc *sc;
   1005  1.12  kiyohara 	struct slhci_pipe *spipe;
   1006  1.12  kiyohara 	usb_endpoint_descriptor_t *ed;
   1007  1.12  kiyohara 	unsigned int max_packet, pmaxpkt;
   1008  1.48     skrll 	uint8_t rhaddr;
   1009  1.12  kiyohara 
   1010  1.48     skrll 	dev = pipe->up_dev;
   1011  1.48     skrll 	sc = SLHCI_PIPE2SC(pipe);
   1012  1.48     skrll 	spipe = SLHCI_PIPE2SPIPE(pipe);
   1013  1.48     skrll 	ed = pipe->up_endpoint->ue_edesc;
   1014  1.48     skrll 	rhaddr = dev->ud_bus->ub_rhaddr;
   1015  1.12  kiyohara 
   1016  1.12  kiyohara 	DLOG(D_TRACE, "slhci_open(addr=%d,ep=%d,rootaddr=%d)",
   1017  1.48     skrll 		dev->ud_addr, ed->bEndpointAddress, rhaddr, 0);
   1018  1.12  kiyohara 
   1019  1.12  kiyohara 	spipe->pflags = 0;
   1020  1.12  kiyohara 	spipe->frame = 0;
   1021  1.12  kiyohara 	spipe->lastframe = 0;
   1022  1.12  kiyohara 	spipe->xfer = NULL;
   1023  1.12  kiyohara 	spipe->buffer = NULL;
   1024  1.12  kiyohara 
   1025  1.12  kiyohara 	gcq_init(&spipe->ap);
   1026  1.12  kiyohara 	gcq_init(&spipe->to);
   1027  1.12  kiyohara 	gcq_init(&spipe->xq);
   1028  1.12  kiyohara 
   1029  1.34     skrll 	/*
   1030  1.34     skrll 	 * The endpoint descriptor will not have been set up yet in the case
   1031  1.37     skrll 	 * of the standard control pipe, so the max packet checks are also
   1032  1.34     skrll 	 * necessary in start.
   1033  1.34     skrll 	 */
   1034  1.12  kiyohara 
   1035  1.12  kiyohara 	max_packet = UGETW(ed->wMaxPacketSize);
   1036  1.12  kiyohara 
   1037  1.48     skrll 	if (dev->ud_speed == USB_SPEED_LOW) {
   1038  1.12  kiyohara 		spipe->pflags |= PF_LS;
   1039  1.48     skrll 		if (dev->ud_myhub->ud_addr != rhaddr) {
   1040  1.12  kiyohara 			spipe->pflags |= PF_PREAMBLE;
   1041  1.12  kiyohara 			if (!slhci_try_lsvh)
   1042  1.36     skrll 				return slhci_lock_call(sc, &slhci_lsvh_warn,
   1043  1.12  kiyohara 				    spipe, NULL);
   1044  1.12  kiyohara 		}
   1045  1.12  kiyohara 		pmaxpkt = 8;
   1046  1.12  kiyohara 	} else
   1047  1.12  kiyohara 		pmaxpkt = SL11_MAX_PACKET_SIZE;
   1048  1.12  kiyohara 
   1049  1.12  kiyohara 	if (max_packet > pmaxpkt) {
   1050  1.36     skrll 		DLOG(D_ERR, "packet too large! size %d spipe %p", max_packet,
   1051  1.12  kiyohara 		    spipe, 0,0);
   1052  1.12  kiyohara 		return USBD_INVAL;
   1053  1.12  kiyohara 	}
   1054   1.1     isaki 
   1055  1.48     skrll 	if (dev->ud_addr == rhaddr) {
   1056   1.1     isaki 		switch (ed->bEndpointAddress) {
   1057   1.1     isaki 		case USB_CONTROL_ENDPOINT:
   1058  1.12  kiyohara 			spipe->ptype = PT_ROOT_CTRL;
   1059  1.48     skrll 			pipe->up_interval = 0;
   1060  1.48     skrll 			pipe->up_methods = &roothub_ctrl_methods;
   1061   1.1     isaki 			break;
   1062  1.48     skrll 		case UE_DIR_IN | USBROOTHUB_INTR_ENDPT:
   1063  1.12  kiyohara 			spipe->ptype = PT_ROOT_INTR;
   1064  1.48     skrll 			pipe->up_interval = 1;
   1065  1.48     skrll 			pipe->up_methods = &slhci_root_methods;
   1066   1.1     isaki 			break;
   1067   1.1     isaki 		default:
   1068  1.12  kiyohara 			printf("%s: Invalid root endpoint!\n", SC_NAME(sc));
   1069  1.36     skrll 			DDOLOG("%s: Invalid root endpoint!\n", SC_NAME(sc),
   1070  1.12  kiyohara 			    0,0,0);
   1071   1.1     isaki 			return USBD_INVAL;
   1072   1.1     isaki 		}
   1073  1.12  kiyohara 		return USBD_NORMAL_COMPLETION;
   1074   1.1     isaki 	} else {
   1075   1.1     isaki 		switch (ed->bmAttributes & UE_XFERTYPE) {
   1076   1.1     isaki 		case UE_CONTROL:
   1077  1.12  kiyohara 			spipe->ptype = PT_CTRL_SETUP;
   1078  1.48     skrll 			pipe->up_interval = 0;
   1079   1.1     isaki 			break;
   1080   1.1     isaki 		case UE_INTERRUPT:
   1081  1.12  kiyohara 			spipe->ptype = PT_INTR;
   1082  1.48     skrll 			if (pipe->up_interval == USBD_DEFAULT_INTERVAL)
   1083  1.48     skrll 				pipe->up_interval = ed->bInterval;
   1084   1.1     isaki 			break;
   1085   1.1     isaki 		case UE_ISOCHRONOUS:
   1086  1.36     skrll 			return slhci_lock_call(sc, &slhci_isoc_warn, spipe,
   1087  1.12  kiyohara 			    NULL);
   1088   1.1     isaki 		case UE_BULK:
   1089  1.12  kiyohara 			spipe->ptype = PT_BULK;
   1090  1.48     skrll 			pipe->up_interval = 0;
   1091   1.1     isaki 			break;
   1092   1.1     isaki 		}
   1093  1.12  kiyohara 
   1094  1.36     skrll 		DLOG(D_MSG, "open pipe %s interval %d", pnames(spipe->ptype),
   1095  1.48     skrll 		    pipe->up_interval, 0,0);
   1096  1.12  kiyohara 
   1097  1.48     skrll 		pipe->up_methods = __UNCONST(&slhci_pipe_methods);
   1098  1.12  kiyohara 
   1099  1.12  kiyohara 		return slhci_lock_call(sc, &slhci_open_pipe, spipe, NULL);
   1100   1.1     isaki 	}
   1101   1.1     isaki }
   1102   1.1     isaki 
   1103  1.12  kiyohara int
   1104  1.12  kiyohara slhci_supported_rev(uint8_t rev)
   1105   1.1     isaki {
   1106  1.48     skrll 	return rev >= SLTYPE_SL811HS_R12 && rev <= SLTYPE_SL811HS_R15;
   1107   1.1     isaki }
   1108   1.1     isaki 
   1109  1.34     skrll /*
   1110  1.34     skrll  * Must be called before the ISR is registered. Interrupts can be shared so
   1111  1.37     skrll  * slhci_intr could be called as soon as the ISR is registered.
   1112  1.34     skrll  * Note max_current argument is actual current, but stored as current/2
   1113  1.34     skrll  */
   1114   1.1     isaki void
   1115  1.36     skrll slhci_preinit(struct slhci_softc *sc, PowerFunc pow, bus_space_tag_t iot,
   1116  1.29  kiyohara     bus_space_handle_t ioh, uint16_t max_current, uint32_t stride)
   1117   1.1     isaki {
   1118  1.12  kiyohara 	struct slhci_transfers *t;
   1119  1.12  kiyohara 	int i;
   1120  1.12  kiyohara 
   1121  1.12  kiyohara 	t = &sc->sc_transfers;
   1122  1.12  kiyohara 
   1123  1.41     skrll 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
   1124  1.57     skrll 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_USB);
   1125  1.41     skrll 
   1126  1.12  kiyohara 	/* sc->sc_ier = 0;	*/
   1127  1.12  kiyohara 	/* t->rootintr = NULL;	*/
   1128  1.12  kiyohara 	t->flags = F_NODEV|F_UDISABLED;
   1129  1.12  kiyohara 	t->pend = INT_MAX;
   1130  1.12  kiyohara 	KASSERT(slhci_wait_time != INT_MAX);
   1131  1.12  kiyohara 	t->len[0] = t->len[1] = -1;
   1132  1.12  kiyohara 	if (max_current > 500)
   1133  1.12  kiyohara 		max_current = 500;
   1134  1.12  kiyohara 	t->max_current = (uint8_t)(max_current / 2);
   1135  1.12  kiyohara 	sc->sc_enable_power = pow;
   1136  1.12  kiyohara 	sc->sc_iot = iot;
   1137  1.12  kiyohara 	sc->sc_ioh = ioh;
   1138  1.12  kiyohara 	sc->sc_stride = stride;
   1139  1.12  kiyohara 
   1140  1.12  kiyohara 	KASSERT(Q_MAX+1 == sizeof(t->q) / sizeof(t->q[0]));
   1141  1.12  kiyohara 
   1142  1.12  kiyohara 	for (i = 0; i <= Q_MAX; i++)
   1143  1.12  kiyohara 		gcq_init_head(&t->q[i]);
   1144  1.12  kiyohara 	gcq_init_head(&t->timed);
   1145  1.12  kiyohara 	gcq_init_head(&t->to);
   1146  1.12  kiyohara 	gcq_init_head(&t->ap);
   1147  1.12  kiyohara 	gcq_init_head(&sc->sc_waitq);
   1148   1.1     isaki }
   1149   1.1     isaki 
   1150  1.12  kiyohara int
   1151  1.12  kiyohara slhci_attach(struct slhci_softc *sc)
   1152   1.1     isaki {
   1153  1.41     skrll 	struct slhci_transfers *t;
   1154  1.41     skrll 	const char *rev;
   1155  1.41     skrll 
   1156  1.41     skrll 	t = &sc->sc_transfers;
   1157  1.41     skrll 
   1158  1.41     skrll 	/* Detect and check the controller type */
   1159  1.41     skrll 	t->sltype = SL11_GET_REV(slhci_read(sc, SL11_REV));
   1160  1.41     skrll 
   1161  1.41     skrll 	/* SL11H not supported */
   1162  1.41     skrll 	if (!slhci_supported_rev(t->sltype)) {
   1163  1.41     skrll 		if (t->sltype == SLTYPE_SL11H)
   1164  1.41     skrll 			printf("%s: SL11H unsupported or bus error!\n",
   1165  1.41     skrll 			    SC_NAME(sc));
   1166  1.41     skrll 		else
   1167  1.41     skrll 			printf("%s: Unknown chip revision!\n", SC_NAME(sc));
   1168  1.12  kiyohara 		return -1;
   1169  1.41     skrll 	}
   1170  1.41     skrll 
   1171  1.41     skrll 	callout_init(&sc->sc_timer, CALLOUT_MPSAFE);
   1172  1.41     skrll 	callout_setfunc(&sc->sc_timer, slhci_reset_entry, sc);
   1173  1.41     skrll 
   1174  1.41     skrll 	/*
   1175  1.41     skrll 	 * It is not safe to call the soft interrupt directly as
   1176  1.48     skrll 	 * usb_schedsoftintr does in the ub_usepolling case (due to locking).
   1177  1.41     skrll 	 */
   1178  1.41     skrll 	sc->sc_cb_softintr = softint_establish(SOFTINT_NET,
   1179  1.41     skrll 	    slhci_callback_entry, sc);
   1180  1.41     skrll 
   1181  1.41     skrll #ifdef SLHCI_DEBUG
   1182  1.41     skrll 	ssc = sc;
   1183  1.41     skrll #endif
   1184  1.41     skrll 
   1185  1.41     skrll 	if (t->sltype == SLTYPE_SL811HS_R12)
   1186  1.54     skrll 		rev = "(rev 1.2)";
   1187  1.41     skrll 	else if (t->sltype == SLTYPE_SL811HS_R14)
   1188  1.54     skrll 		rev = "(rev 1.4 or 1.5)";
   1189  1.41     skrll 	else
   1190  1.54     skrll 		rev = "(unknown revision)";
   1191  1.41     skrll 
   1192  1.41     skrll 	aprint_normal("%s: ScanLogic SL811HS/T USB Host Controller %s\n",
   1193  1.41     skrll 	    SC_NAME(sc), rev);
   1194  1.41     skrll 
   1195  1.41     skrll 	aprint_normal("%s: Max Current %u mA (value by code, not by probe)\n",
   1196  1.41     skrll 	    SC_NAME(sc), t->max_current * 2);
   1197  1.41     skrll 
   1198  1.41     skrll #if defined(SLHCI_DEBUG) || defined(SLHCI_NO_OVERTIME) || \
   1199  1.41     skrll     defined(SLHCI_TRY_LSVH) || defined(SLHCI_PROFILE_TRANSFER)
   1200  1.41     skrll 	aprint_normal("%s: driver options:"
   1201  1.41     skrll #ifdef SLHCI_DEBUG
   1202  1.41     skrll 	" SLHCI_DEBUG"
   1203  1.41     skrll #endif
   1204  1.41     skrll #ifdef SLHCI_TRY_LSVH
   1205  1.41     skrll 	" SLHCI_TRY_LSVH"
   1206  1.41     skrll #endif
   1207  1.41     skrll #ifdef SLHCI_NO_OVERTIME
   1208  1.41     skrll 	" SLHCI_NO_OVERTIME"
   1209  1.41     skrll #endif
   1210  1.41     skrll #ifdef SLHCI_PROFILE_TRANSFER
   1211  1.41     skrll 	" SLHCI_PROFILE_TRANSFER"
   1212  1.41     skrll #endif
   1213  1.41     skrll 	"\n", SC_NAME(sc));
   1214  1.41     skrll #endif
   1215  1.48     skrll 	sc->sc_bus.ub_revision = USBREV_1_1;
   1216  1.48     skrll 	sc->sc_bus.ub_methods = __UNCONST(&slhci_bus_methods);
   1217  1.48     skrll 	sc->sc_bus.ub_pipesize = sizeof(struct slhci_pipe);
   1218  1.48     skrll 	sc->sc_bus.ub_usedma = false;
   1219  1.41     skrll 
   1220  1.41     skrll 	if (!sc->sc_enable_power)
   1221  1.41     skrll 		t->flags |= F_REALPOWER;
   1222  1.41     skrll 
   1223  1.41     skrll 	t->flags |= F_ACTIVE;
   1224   1.1     isaki 
   1225  1.12  kiyohara 	/* Attach usb and uhub. */
   1226  1.12  kiyohara 	sc->sc_child = config_found(SC_DEV(sc), &sc->sc_bus, usbctlprint);
   1227   1.1     isaki 
   1228  1.12  kiyohara 	if (!sc->sc_child)
   1229  1.12  kiyohara 		return -1;
   1230  1.12  kiyohara 	else
   1231  1.12  kiyohara 		return 0;
   1232   1.1     isaki }
   1233   1.1     isaki 
   1234  1.12  kiyohara int
   1235  1.12  kiyohara slhci_detach(struct slhci_softc *sc, int flags)
   1236   1.1     isaki {
   1237  1.12  kiyohara 	struct slhci_transfers *t;
   1238  1.12  kiyohara 	int ret;
   1239   1.1     isaki 
   1240  1.12  kiyohara 	t = &sc->sc_transfers;
   1241  1.12  kiyohara 
   1242  1.12  kiyohara 	/* By this point bus access is no longer allowed. */
   1243  1.12  kiyohara 
   1244  1.12  kiyohara 	KASSERT(!(t->flags & F_ACTIVE));
   1245  1.12  kiyohara 
   1246  1.34     skrll 	/*
   1247  1.34     skrll 	 * To be MPSAFE is not sufficient to cancel callouts and soft
   1248  1.13  kiyohara 	 * interrupts and assume they are dead since the code could already be
   1249  1.34     skrll 	 * running or about to run.  Wait until they are known to be done.
   1250  1.34     skrll 	 */
   1251  1.12  kiyohara 	while (t->flags & (F_RESET|F_CALLBACK))
   1252  1.12  kiyohara 		tsleep(&sc, PPAUSE, "slhci_detach", hz);
   1253  1.12  kiyohara 
   1254  1.16        ad 	softint_disestablish(sc->sc_cb_softintr);
   1255  1.12  kiyohara 
   1256  1.41     skrll 	mutex_destroy(&sc->sc_lock);
   1257  1.41     skrll 	mutex_destroy(&sc->sc_intr_lock);
   1258  1.41     skrll 
   1259  1.12  kiyohara 	ret = 0;
   1260  1.12  kiyohara 
   1261  1.12  kiyohara 	if (sc->sc_child)
   1262  1.12  kiyohara 		ret = config_detach(sc->sc_child, flags);
   1263  1.12  kiyohara 
   1264  1.12  kiyohara #ifdef SLHCI_MEM_ACCOUNTING
   1265  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1266  1.12  kiyohara 	if (sc->sc_mem_use) {
   1267  1.12  kiyohara 		printf("%s: Memory still in use after detach! mem_use (count)"
   1268  1.12  kiyohara 		    " = %d\n", SC_NAME(sc), sc->sc_mem_use);
   1269  1.12  kiyohara 		DDOLOG("%s: Memory still in use after detach! mem_use (count)"
   1270  1.12  kiyohara 		    " = %d\n", SC_NAME(sc), sc->sc_mem_use, 0,0);
   1271  1.12  kiyohara 	}
   1272  1.12  kiyohara #endif
   1273  1.12  kiyohara 
   1274  1.12  kiyohara 	return ret;
   1275  1.12  kiyohara }
   1276  1.12  kiyohara 
   1277  1.12  kiyohara int
   1278  1.23    cegger slhci_activate(device_t self, enum devact act)
   1279  1.12  kiyohara {
   1280  1.24    dyoung 	struct slhci_softc *sc = device_private(self);
   1281  1.12  kiyohara 
   1282  1.24    dyoung 	switch (act) {
   1283  1.24    dyoung 	case DVACT_DEACTIVATE:
   1284  1.24    dyoung 		slhci_lock_call(sc, &slhci_halt, NULL, NULL);
   1285  1.24    dyoung 		return 0;
   1286  1.24    dyoung 	default:
   1287  1.12  kiyohara 		return EOPNOTSUPP;
   1288  1.24    dyoung 	}
   1289  1.12  kiyohara }
   1290   1.1     isaki 
   1291   1.1     isaki void
   1292  1.12  kiyohara slhci_abort(struct usbd_xfer *xfer)
   1293   1.1     isaki {
   1294  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1295  1.12  kiyohara 	struct slhci_softc *sc;
   1296  1.12  kiyohara 	struct slhci_pipe *spipe;
   1297  1.12  kiyohara 
   1298  1.48     skrll 	spipe = SLHCI_PIPE2SPIPE(xfer->ux_pipe);
   1299  1.12  kiyohara 
   1300  1.12  kiyohara 	if (spipe == NULL)
   1301  1.12  kiyohara 		goto callback;
   1302  1.12  kiyohara 
   1303  1.48     skrll 	sc = SLHCI_XFER2SC(xfer);
   1304  1.46     joerg 	KASSERT(mutex_owned(&sc->sc_lock));
   1305  1.46     joerg 
   1306  1.36     skrll 	DLOG(D_TRACE, "%s abort xfer %p spipe %p spipe->xfer %p",
   1307  1.12  kiyohara 	    pnames(spipe->ptype), xfer, spipe, spipe->xfer);
   1308  1.12  kiyohara 
   1309  1.12  kiyohara 	slhci_lock_call(sc, &slhci_do_abort, spipe, xfer);
   1310   1.1     isaki 
   1311  1.12  kiyohara callback:
   1312  1.48     skrll 	xfer->ux_status = USBD_CANCELLED;
   1313  1.12  kiyohara 	usb_transfer_complete(xfer);
   1314   1.1     isaki }
   1315   1.1     isaki 
   1316  1.12  kiyohara void
   1317  1.12  kiyohara slhci_close(struct usbd_pipe *pipe)
   1318   1.1     isaki {
   1319  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1320  1.12  kiyohara 	struct slhci_softc *sc;
   1321  1.12  kiyohara 	struct slhci_pipe *spipe;
   1322   1.1     isaki 
   1323  1.48     skrll 	sc = SLHCI_PIPE2SC(pipe);
   1324  1.48     skrll 	spipe = SLHCI_PIPE2SPIPE(pipe);
   1325   1.1     isaki 
   1326  1.36     skrll 	DLOG(D_TRACE, "%s close spipe %p spipe->xfer %p",
   1327  1.12  kiyohara 	    pnames(spipe->ptype), spipe, spipe->xfer, 0);
   1328   1.1     isaki 
   1329  1.12  kiyohara 	slhci_lock_call(sc, &slhci_close_pipe, spipe, NULL);
   1330   1.1     isaki }
   1331   1.1     isaki 
   1332   1.1     isaki void
   1333  1.12  kiyohara slhci_clear_toggle(struct usbd_pipe *pipe)
   1334   1.1     isaki {
   1335  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1336  1.12  kiyohara 	struct slhci_pipe *spipe;
   1337  1.12  kiyohara 
   1338  1.48     skrll 	spipe = SLHCI_PIPE2SPIPE(pipe);
   1339  1.12  kiyohara 
   1340  1.36     skrll 	DLOG(D_TRACE, "%s toggle spipe %p", pnames(spipe->ptype),
   1341  1.12  kiyohara 	    spipe,0,0);
   1342   1.1     isaki 
   1343  1.12  kiyohara 	spipe->pflags &= ~PF_TOGGLE;
   1344   1.2     isaki 
   1345   1.2     isaki #ifdef DIAGNOSTIC
   1346  1.12  kiyohara 	if (spipe->xfer != NULL) {
   1347  1.36     skrll 		struct slhci_softc *sc = (struct slhci_softc
   1348  1.48     skrll 		    *)pipe->up_dev->ud_bus;
   1349  1.12  kiyohara 
   1350  1.36     skrll 		printf("%s: Clear toggle on transfer in progress! halted\n",
   1351  1.12  kiyohara 		    SC_NAME(sc));
   1352  1.36     skrll 		DDOLOG("%s: Clear toggle on transfer in progress! halted\n",
   1353  1.12  kiyohara 		    SC_NAME(sc), 0,0,0);
   1354  1.12  kiyohara 		slhci_halt(sc, NULL, NULL);
   1355   1.2     isaki 	}
   1356   1.2     isaki #endif
   1357   1.1     isaki }
   1358   1.1     isaki 
   1359   1.1     isaki void
   1360  1.12  kiyohara slhci_poll(struct usbd_bus *bus) /* XXX necessary? */
   1361   1.1     isaki {
   1362  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1363  1.12  kiyohara 	struct slhci_softc *sc;
   1364  1.12  kiyohara 
   1365  1.48     skrll 	sc = SLHCI_BUS2SC(bus);
   1366  1.12  kiyohara 
   1367  1.12  kiyohara 	DLOG(D_TRACE, "slhci_poll", 0,0,0,0);
   1368  1.12  kiyohara 
   1369  1.12  kiyohara 	slhci_lock_call(sc, &slhci_do_poll, NULL, NULL);
   1370   1.1     isaki }
   1371   1.1     isaki 
   1372  1.12  kiyohara void
   1373  1.12  kiyohara slhci_done(struct usbd_xfer *xfer)
   1374  1.12  kiyohara {
   1375  1.12  kiyohara }
   1376   1.1     isaki 
   1377  1.12  kiyohara void
   1378  1.12  kiyohara slhci_void(void *v) {}
   1379   1.1     isaki 
   1380  1.12  kiyohara /* End out of lock functions. Start lock entry functions. */
   1381   1.1     isaki 
   1382  1.12  kiyohara #ifdef SLHCI_MEM_ACCOUNTING
   1383  1.12  kiyohara void
   1384  1.12  kiyohara slhci_mem_use(struct usbd_bus *bus, int val)
   1385  1.12  kiyohara {
   1386  1.48     skrll 	struct slhci_softc *sc = SLHCI_BUS2SC(bus);
   1387   1.1     isaki 
   1388  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1389  1.12  kiyohara 	sc->sc_mem_use += val;
   1390  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1391  1.12  kiyohara }
   1392  1.12  kiyohara #endif
   1393   1.1     isaki 
   1394  1.12  kiyohara void
   1395  1.12  kiyohara slhci_reset_entry(void *arg)
   1396   1.1     isaki {
   1397  1.59     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1398  1.41     skrll 	struct slhci_softc *sc = arg;
   1399  1.12  kiyohara 
   1400  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1401  1.12  kiyohara 	slhci_reset(sc);
   1402  1.34     skrll 	/*
   1403  1.39     skrll 	 * We cannot call the callback directly since we could then be reset
   1404  1.37     skrll 	 * again before finishing and need the callout delay for timing.
   1405  1.37     skrll 	 * Scheduling the callout again before we exit would defeat the reap
   1406  1.37     skrll 	 * mechanism since we could be unlocked while the reset flag is not
   1407  1.34     skrll 	 * set. The callback code will check the wait queue.
   1408  1.34     skrll 	 */
   1409  1.12  kiyohara 	slhci_callback_schedule(sc);
   1410  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1411   1.1     isaki }
   1412   1.1     isaki 
   1413   1.1     isaki usbd_status
   1414  1.36     skrll slhci_lock_call(struct slhci_softc *sc, LockCallFunc lcf, struct slhci_pipe
   1415  1.12  kiyohara     *spipe, struct usbd_xfer *xfer)
   1416  1.12  kiyohara {
   1417  1.12  kiyohara 	usbd_status ret;
   1418  1.12  kiyohara 
   1419  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1420  1.12  kiyohara 	ret = (*lcf)(sc, spipe, xfer);
   1421  1.41     skrll 	slhci_main(sc);
   1422  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1423  1.12  kiyohara 
   1424  1.12  kiyohara 	return ret;
   1425  1.12  kiyohara }
   1426  1.12  kiyohara 
   1427  1.12  kiyohara void
   1428  1.12  kiyohara slhci_start_entry(struct slhci_softc *sc, struct slhci_pipe *spipe)
   1429   1.1     isaki {
   1430  1.12  kiyohara 	struct slhci_transfers *t;
   1431   1.1     isaki 
   1432  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1433  1.12  kiyohara 	t = &sc->sc_transfers;
   1434   1.1     isaki 
   1435  1.41     skrll 	if (!(t->flags & (F_AINPROG|F_BINPROG))) {
   1436  1.12  kiyohara 		slhci_enter_xfer(sc, spipe);
   1437  1.12  kiyohara 		slhci_dotransfer(sc);
   1438  1.41     skrll 		slhci_main(sc);
   1439  1.12  kiyohara 	} else {
   1440  1.12  kiyohara 		enter_waitq(sc, spipe);
   1441   1.1     isaki 	}
   1442  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1443   1.1     isaki }
   1444   1.1     isaki 
   1445  1.12  kiyohara void
   1446  1.12  kiyohara slhci_callback_entry(void *arg)
   1447   1.1     isaki {
   1448  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1449  1.12  kiyohara 	struct slhci_softc *sc;
   1450  1.12  kiyohara 	struct slhci_transfers *t;
   1451   1.1     isaki 
   1452  1.41     skrll 	sc = (struct slhci_softc *)arg;
   1453   1.1     isaki 
   1454  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1455  1.12  kiyohara 	t = &sc->sc_transfers;
   1456  1.12  kiyohara 	DLOG(D_SOFT, "callback_entry flags %#x", t->flags, 0,0,0);
   1457   1.1     isaki 
   1458  1.12  kiyohara repeat:
   1459  1.41     skrll 	slhci_callback(sc);
   1460   1.1     isaki 
   1461  1.12  kiyohara 	if (!gcq_empty(&sc->sc_waitq)) {
   1462  1.12  kiyohara 		slhci_enter_xfers(sc);
   1463  1.12  kiyohara 		slhci_dotransfer(sc);
   1464  1.12  kiyohara 		slhci_waitintr(sc, 0);
   1465  1.12  kiyohara 		goto repeat;
   1466  1.12  kiyohara 	}
   1467   1.1     isaki 
   1468  1.12  kiyohara 	t->flags &= ~F_CALLBACK;
   1469  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1470   1.1     isaki }
   1471   1.1     isaki 
   1472   1.1     isaki void
   1473  1.41     skrll slhci_do_callback(struct slhci_softc *sc, struct usbd_xfer *xfer)
   1474   1.1     isaki {
   1475  1.62     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1476  1.43     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   1477  1.12  kiyohara 
   1478  1.12  kiyohara 	start_cc_time(&t_callback, (u_int)xfer);
   1479  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1480  1.12  kiyohara 
   1481  1.41     skrll 	mutex_enter(&sc->sc_lock);
   1482  1.12  kiyohara 	usb_transfer_complete(xfer);
   1483  1.41     skrll 	mutex_exit(&sc->sc_lock);
   1484  1.12  kiyohara 
   1485  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1486  1.12  kiyohara 	stop_cc_time(&t_callback);
   1487   1.1     isaki }
   1488   1.1     isaki 
   1489  1.12  kiyohara int
   1490  1.12  kiyohara slhci_intr(void *arg)
   1491   1.1     isaki {
   1492  1.58     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1493  1.41     skrll 	struct slhci_softc *sc = arg;
   1494  1.12  kiyohara 	int ret;
   1495  1.12  kiyohara 
   1496  1.12  kiyohara 	start_cc_time(&t_hard_int, (unsigned int)arg);
   1497  1.41     skrll 	mutex_enter(&sc->sc_intr_lock);
   1498  1.12  kiyohara 
   1499  1.12  kiyohara 	ret = slhci_dointr(sc);
   1500  1.41     skrll 	slhci_main(sc);
   1501  1.41     skrll 	mutex_exit(&sc->sc_intr_lock);
   1502  1.12  kiyohara 
   1503  1.12  kiyohara 	stop_cc_time(&t_hard_int);
   1504  1.12  kiyohara 	return ret;
   1505   1.1     isaki }
   1506   1.1     isaki 
   1507  1.12  kiyohara /* called with main lock only held, returns with locks released. */
   1508   1.1     isaki void
   1509  1.41     skrll slhci_main(struct slhci_softc *sc)
   1510   1.1     isaki {
   1511  1.58     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1512  1.12  kiyohara 	struct slhci_transfers *t;
   1513  1.12  kiyohara 
   1514  1.12  kiyohara 	t = &sc->sc_transfers;
   1515   1.1     isaki 
   1516  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   1517   1.1     isaki 
   1518  1.12  kiyohara waitcheck:
   1519  1.12  kiyohara 	slhci_waitintr(sc, slhci_wait_time);
   1520   1.1     isaki 
   1521   1.1     isaki 	/*
   1522  1.48     skrll 	 * The direct call is needed in the ub_usepolling and disabled cases
   1523  1.36     skrll 	 * since the soft interrupt is not available.  In the disabled case,
   1524  1.36     skrll 	 * this code can be reached from the usb detach, after the reaping of
   1525  1.41     skrll 	 * the soft interrupt.  That test could be !F_ACTIVE, but there is no
   1526  1.41     skrll 	 * reason not to make the callbacks directly in the other DISABLED
   1527  1.41     skrll 	 * cases.
   1528   1.1     isaki 	 */
   1529  1.12  kiyohara 	if ((t->flags & F_ROOTINTR) || !gcq_empty(&t->q[Q_CALLBACKS])) {
   1530  1.48     skrll 		if (__predict_false(sc->sc_bus.ub_usepolling ||
   1531  1.41     skrll 		    t->flags & F_DISABLED))
   1532  1.41     skrll 			slhci_callback(sc);
   1533  1.12  kiyohara 		else
   1534  1.12  kiyohara 			slhci_callback_schedule(sc);
   1535  1.12  kiyohara 	}
   1536  1.12  kiyohara 
   1537  1.12  kiyohara 	if (!gcq_empty(&sc->sc_waitq)) {
   1538  1.12  kiyohara 		slhci_enter_xfers(sc);
   1539  1.12  kiyohara 		slhci_dotransfer(sc);
   1540  1.12  kiyohara 		goto waitcheck;
   1541  1.12  kiyohara 	}
   1542   1.1     isaki }
   1543   1.1     isaki 
   1544  1.12  kiyohara /* End lock entry functions. Start in lock function. */
   1545  1.12  kiyohara 
   1546  1.12  kiyohara /* Register read/write routines and barriers. */
   1547  1.12  kiyohara #ifdef SLHCI_BUS_SPACE_BARRIERS
   1548  1.12  kiyohara #define BSB(a, b, c, d, e) bus_space_barrier(a, b, c, d, BUS_SPACE_BARRIER_ # e)
   1549  1.12  kiyohara #define BSB_SYNC(a, b, c, d) bus_space_barrier(a, b, c, d, BUS_SPACE_BARRIER_SYNC)
   1550  1.12  kiyohara #else /* now !SLHCI_BUS_SPACE_BARRIERS */
   1551  1.47  christos #define BSB(a, b, c, d, e) __USE(d)
   1552  1.12  kiyohara #define BSB_SYNC(a, b, c, d)
   1553  1.12  kiyohara #endif /* SLHCI_BUS_SPACE_BARRIERS */
   1554  1.12  kiyohara 
   1555  1.12  kiyohara static void
   1556  1.12  kiyohara slhci_write(struct slhci_softc *sc, uint8_t addr, uint8_t data)
   1557   1.1     isaki {
   1558  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1559  1.12  kiyohara 	bus_space_tag_t iot;
   1560  1.12  kiyohara 	bus_space_handle_t ioh;
   1561  1.12  kiyohara 
   1562  1.12  kiyohara 	paddr = pst = 0;
   1563  1.12  kiyohara 	pdata = sc->sc_stride;
   1564  1.12  kiyohara 	psz = pdata * 2;
   1565  1.12  kiyohara 	iot = sc->sc_iot;
   1566  1.12  kiyohara 	ioh = sc->sc_ioh;
   1567  1.12  kiyohara 
   1568  1.12  kiyohara 	bus_space_write_1(iot, ioh, paddr, addr);
   1569  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1570  1.12  kiyohara 	bus_space_write_1(iot, ioh, pdata, data);
   1571  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1572  1.12  kiyohara }
   1573  1.12  kiyohara 
   1574  1.12  kiyohara static uint8_t
   1575  1.12  kiyohara slhci_read(struct slhci_softc *sc, uint8_t addr)
   1576  1.12  kiyohara {
   1577  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1578  1.12  kiyohara 	bus_space_tag_t iot;
   1579  1.12  kiyohara 	bus_space_handle_t ioh;
   1580  1.12  kiyohara 	uint8_t data;
   1581  1.12  kiyohara 
   1582  1.12  kiyohara 	paddr = pst = 0;
   1583  1.12  kiyohara 	pdata = sc->sc_stride;
   1584  1.12  kiyohara 	psz = pdata * 2;
   1585  1.12  kiyohara 	iot = sc->sc_iot;
   1586  1.12  kiyohara 	ioh = sc->sc_ioh;
   1587  1.12  kiyohara 
   1588  1.12  kiyohara 	bus_space_write_1(iot, ioh, paddr, addr);
   1589  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_READ);
   1590  1.12  kiyohara 	data = bus_space_read_1(iot, ioh, pdata);
   1591  1.12  kiyohara 	BSB(iot, ioh, pst, psz, READ_BEFORE_WRITE);
   1592  1.12  kiyohara 	return data;
   1593  1.12  kiyohara }
   1594   1.1     isaki 
   1595  1.12  kiyohara #if 0 /* auto-increment mode broken, see errata doc */
   1596  1.12  kiyohara static void
   1597  1.12  kiyohara slhci_write_multi(struct slhci_softc *sc, uint8_t addr, uint8_t *buf, int l)
   1598  1.12  kiyohara {
   1599  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1600  1.12  kiyohara 	bus_space_tag_t iot;
   1601  1.12  kiyohara 	bus_space_handle_t ioh;
   1602  1.12  kiyohara 
   1603  1.12  kiyohara 	paddr = pst = 0;
   1604  1.12  kiyohara 	pdata = sc->sc_stride;
   1605  1.12  kiyohara 	psz = pdata * 2;
   1606  1.12  kiyohara 	iot = sc->sc_iot;
   1607  1.12  kiyohara 	ioh = sc->sc_ioh;
   1608  1.12  kiyohara 
   1609  1.12  kiyohara 	bus_space_write_1(iot, ioh, paddr, addr);
   1610  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1611  1.12  kiyohara 	bus_space_write_multi_1(iot, ioh, pdata, buf, l);
   1612  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1613  1.12  kiyohara }
   1614   1.1     isaki 
   1615  1.12  kiyohara static void
   1616  1.12  kiyohara slhci_read_multi(struct slhci_softc *sc, uint8_t addr, uint8_t *buf, int l)
   1617  1.12  kiyohara {
   1618  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1619  1.12  kiyohara 	bus_space_tag_t iot;
   1620  1.12  kiyohara 	bus_space_handle_t ioh;
   1621  1.12  kiyohara 
   1622  1.12  kiyohara 	paddr = pst = 0;
   1623  1.12  kiyohara 	pdata = sc->sc_stride;
   1624  1.12  kiyohara 	psz = pdata * 2;
   1625  1.12  kiyohara 	iot = sc->sc_iot;
   1626  1.12  kiyohara 	ioh = sc->sc_ioh;
   1627  1.12  kiyohara 
   1628  1.12  kiyohara 	bus_space_write_1(iot, ioh, paddr, addr);
   1629  1.12  kiyohara 	BSB(iot, ioh, pst, psz, WRITE_BEFORE_READ);
   1630  1.12  kiyohara 	bus_space_read_multi_1(iot, ioh, pdata, buf, l);
   1631  1.12  kiyohara 	BSB(iot, ioh, pst, psz, READ_BEFORE_WRITE);
   1632   1.1     isaki }
   1633  1.12  kiyohara #else
   1634   1.1     isaki static void
   1635  1.12  kiyohara slhci_write_multi(struct slhci_softc *sc, uint8_t addr, uint8_t *buf, int l)
   1636   1.1     isaki {
   1637  1.12  kiyohara #if 1
   1638  1.12  kiyohara 	for (; l; addr++, buf++, l--)
   1639  1.12  kiyohara 		slhci_write(sc, addr, *buf);
   1640  1.12  kiyohara #else
   1641  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1642  1.12  kiyohara 	bus_space_tag_t iot;
   1643  1.12  kiyohara 	bus_space_handle_t ioh;
   1644  1.12  kiyohara 
   1645  1.12  kiyohara 	paddr = pst = 0;
   1646  1.12  kiyohara 	pdata = sc->sc_stride;
   1647  1.12  kiyohara 	psz = pdata * 2;
   1648  1.12  kiyohara 	iot = sc->sc_iot;
   1649  1.12  kiyohara 	ioh = sc->sc_ioh;
   1650  1.12  kiyohara 
   1651  1.12  kiyohara 	for (; l; addr++, buf++, l--) {
   1652  1.12  kiyohara 		bus_space_write_1(iot, ioh, paddr, addr);
   1653  1.12  kiyohara 		BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1654  1.12  kiyohara 		bus_space_write_1(iot, ioh, pdata, *buf);
   1655  1.12  kiyohara 		BSB(iot, ioh, pst, psz, WRITE_BEFORE_WRITE);
   1656  1.12  kiyohara 	}
   1657  1.12  kiyohara #endif
   1658   1.1     isaki }
   1659   1.1     isaki 
   1660   1.1     isaki static void
   1661  1.12  kiyohara slhci_read_multi(struct slhci_softc *sc, uint8_t addr, uint8_t *buf, int l)
   1662   1.1     isaki {
   1663  1.12  kiyohara #if 1
   1664  1.12  kiyohara 	for (; l; addr++, buf++, l--)
   1665  1.12  kiyohara 		*buf = slhci_read(sc, addr);
   1666  1.12  kiyohara #else
   1667  1.12  kiyohara 	bus_size_t paddr, pdata, pst, psz;
   1668  1.12  kiyohara 	bus_space_tag_t iot;
   1669  1.12  kiyohara 	bus_space_handle_t ioh;
   1670  1.12  kiyohara 
   1671  1.12  kiyohara 	paddr = pst = 0;
   1672  1.12  kiyohara 	pdata = sc->sc_stride;
   1673  1.12  kiyohara 	psz = pdata * 2;
   1674  1.12  kiyohara 	iot = sc->sc_iot;
   1675  1.12  kiyohara 	ioh = sc->sc_ioh;
   1676  1.12  kiyohara 
   1677  1.12  kiyohara 	for (; l; addr++, buf++, l--) {
   1678  1.12  kiyohara 		bus_space_write_1(iot, ioh, paddr, addr);
   1679  1.12  kiyohara 		BSB(iot, ioh, pst, psz, WRITE_BEFORE_READ);
   1680  1.12  kiyohara 		*buf = bus_space_read_1(iot, ioh, pdata);
   1681  1.12  kiyohara 		BSB(iot, ioh, pst, psz, READ_BEFORE_WRITE);
   1682  1.12  kiyohara 	}
   1683  1.12  kiyohara #endif
   1684  1.12  kiyohara }
   1685  1.12  kiyohara #endif
   1686  1.12  kiyohara 
   1687  1.34     skrll /*
   1688  1.34     skrll  * After calling waitintr it is necessary to either call slhci_callback or
   1689  1.37     skrll  * schedule the callback if necessary.  The callback cannot be called directly
   1690  1.37     skrll  * from the hard interrupt since it interrupts at a high IPL and callbacks
   1691  1.34     skrll  * can do copyout and such.
   1692  1.34     skrll  */
   1693  1.12  kiyohara static void
   1694  1.12  kiyohara slhci_waitintr(struct slhci_softc *sc, int wait_time)
   1695  1.12  kiyohara {
   1696  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1697  1.12  kiyohara 	struct slhci_transfers *t;
   1698  1.12  kiyohara 
   1699  1.12  kiyohara 	t = &sc->sc_transfers;
   1700  1.12  kiyohara 
   1701  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   1702  1.12  kiyohara 
   1703  1.48     skrll 	if (__predict_false(sc->sc_bus.ub_usepolling))
   1704  1.12  kiyohara 		wait_time = 12000;
   1705  1.12  kiyohara 
   1706  1.12  kiyohara 	while (t->pend <= wait_time) {
   1707  1.36     skrll 		DLOG(D_WAIT, "waiting... frame %d pend %d flags %#x",
   1708  1.12  kiyohara 		    t->frame, t->pend, t->flags, 0);
   1709  1.12  kiyohara 		LK_SLASSERT(t->flags & F_ACTIVE, sc, NULL, NULL, return);
   1710  1.36     skrll 		LK_SLASSERT(t->flags & (F_AINPROG|F_BINPROG), sc, NULL, NULL,
   1711  1.12  kiyohara 		    return);
   1712  1.12  kiyohara 		slhci_dointr(sc);
   1713  1.12  kiyohara 	}
   1714  1.12  kiyohara }
   1715  1.12  kiyohara 
   1716  1.12  kiyohara static int
   1717  1.12  kiyohara slhci_dointr(struct slhci_softc *sc)
   1718  1.12  kiyohara {
   1719  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1720  1.12  kiyohara 	struct slhci_transfers *t;
   1721  1.12  kiyohara 	struct slhci_pipe *tosp;
   1722  1.12  kiyohara 	uint8_t r;
   1723  1.12  kiyohara 
   1724  1.12  kiyohara 	t = &sc->sc_transfers;
   1725  1.12  kiyohara 
   1726  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   1727  1.12  kiyohara 
   1728  1.67     skrll 	DLOG(D_INTR, "Flags %#x sc_ier %#x ISR=%#x", t->flags, sc->sc_ier,
   1729  1.65     skrll 	    slhci_read(sc, SL11_ISR), 0);
   1730  1.65     skrll 
   1731  1.12  kiyohara 	if (sc->sc_ier == 0)
   1732  1.12  kiyohara 		return 0;
   1733  1.12  kiyohara 
   1734  1.12  kiyohara 	r = slhci_read(sc, SL11_ISR);
   1735  1.12  kiyohara 
   1736  1.12  kiyohara #ifdef SLHCI_DEBUG
   1737  1.51     skrll 	if (slhcidebug & SLHCI_D_INTR && r & sc->sc_ier &&
   1738  1.51     skrll 	    ((r & ~(SL11_ISR_SOF|SL11_ISR_DATA)) || slhcidebug &
   1739  1.12  kiyohara 	    SLHCI_D_SOF)) {
   1740  1.12  kiyohara 		uint8_t e, f;
   1741  1.12  kiyohara 
   1742  1.12  kiyohara 		e = slhci_read(sc, SL11_IER);
   1743  1.12  kiyohara 		f = slhci_read(sc, SL11_CTRL);
   1744  1.12  kiyohara 		DDOLOG("Flags=%#x IER=%#x ISR=%#x", t->flags, e, r, 0);
   1745  1.36     skrll 		DDOLOGFLAG8("Status=", r, "D+", (f & SL11_CTRL_SUSPEND) ?
   1746  1.36     skrll 		    "RESUME" : "NODEV", "INSERT", "SOF", "res", "BABBLE",
   1747  1.12  kiyohara 		    "USBB", "USBA");
   1748  1.12  kiyohara 	}
   1749  1.12  kiyohara #endif
   1750  1.12  kiyohara 
   1751  1.40     skrll 	/*
   1752  1.40     skrll 	 * check IER for corruption occasionally.  Assume that the above
   1753  1.40     skrll 	 * sc_ier == 0 case works correctly.
   1754  1.40     skrll 	 */
   1755  1.12  kiyohara 	if (__predict_false(sc->sc_ier_check++ > SLHCI_IER_CHECK_FREQUENCY)) {
   1756  1.12  kiyohara 		sc->sc_ier_check = 0;
   1757  1.12  kiyohara 		if (sc->sc_ier != slhci_read(sc, SL11_IER)) {
   1758  1.36     skrll 			printf("%s: IER value corrupted! halted\n",
   1759  1.12  kiyohara 			    SC_NAME(sc));
   1760  1.36     skrll 			DDOLOG("%s: IER value corrupted! halted\n",
   1761  1.12  kiyohara 			    SC_NAME(sc), 0,0,0);
   1762  1.36     skrll 			slhci_halt(sc, NULL, NULL);
   1763  1.12  kiyohara 			return 1;
   1764  1.12  kiyohara 		}
   1765  1.12  kiyohara 	}
   1766  1.12  kiyohara 
   1767  1.12  kiyohara 	r &= sc->sc_ier;
   1768  1.12  kiyohara 
   1769  1.12  kiyohara 	if (r == 0)
   1770  1.12  kiyohara 		return 0;
   1771  1.12  kiyohara 
   1772  1.12  kiyohara 	sc->sc_ier_check = 0;
   1773  1.12  kiyohara 
   1774  1.12  kiyohara 	slhci_write(sc, SL11_ISR, r);
   1775  1.12  kiyohara 	BSB_SYNC(sc->iot, sc->ioh, sc->pst, sc->psz);
   1776  1.12  kiyohara 
   1777  1.12  kiyohara 	/* If we have an insertion event we do not care about anything else. */
   1778  1.12  kiyohara 	if (__predict_false(r & SL11_ISR_INSERT)) {
   1779  1.12  kiyohara 		slhci_insert(sc);
   1780  1.12  kiyohara 		return 1;
   1781  1.12  kiyohara 	}
   1782  1.12  kiyohara 
   1783  1.12  kiyohara 	stop_cc_time(&t_intr);
   1784  1.12  kiyohara 	start_cc_time(&t_intr, r);
   1785  1.12  kiyohara 
   1786  1.12  kiyohara 	if (r & SL11_ISR_SOF) {
   1787  1.12  kiyohara 		t->frame++;
   1788  1.12  kiyohara 
   1789  1.12  kiyohara 		gcq_merge_tail(&t->q[Q_CB], &t->q[Q_NEXT_CB]);
   1790  1.12  kiyohara 
   1791  1.34     skrll 		/*
   1792  1.34     skrll 		 * SOFCHECK flags are cleared in tstart.  Two flags are needed
   1793  1.37     skrll 		 * since the first SOF interrupt processed after the transfer
   1794  1.37     skrll 		 * is started might have been generated before the transfer
   1795  1.34     skrll 		 * was started.
   1796  1.34     skrll 		 */
   1797  1.37     skrll 		if (__predict_false(t->flags & F_SOFCHECK2 && t->flags &
   1798  1.12  kiyohara 		    (F_AINPROG|F_BINPROG))) {
   1799  1.12  kiyohara 			printf("%s: Missed transfer completion. halted\n",
   1800  1.12  kiyohara 			    SC_NAME(sc));
   1801  1.12  kiyohara 			DDOLOG("%s: Missed transfer completion. halted\n",
   1802  1.12  kiyohara 			    SC_NAME(sc), 0,0,0);
   1803  1.12  kiyohara 			slhci_halt(sc, NULL, NULL);
   1804  1.12  kiyohara 			return 1;
   1805  1.12  kiyohara 		} else if (t->flags & F_SOFCHECK1) {
   1806  1.12  kiyohara 			t->flags |= F_SOFCHECK2;
   1807  1.12  kiyohara 		} else
   1808  1.12  kiyohara 			t->flags |= F_SOFCHECK1;
   1809  1.12  kiyohara 
   1810  1.12  kiyohara 		if (t->flags & F_CHANGE)
   1811  1.12  kiyohara 			t->flags |= F_ROOTINTR;
   1812  1.12  kiyohara 
   1813  1.12  kiyohara 		while (__predict_true(GOT_FIRST_TO(tosp, t)) &&
   1814  1.12  kiyohara 		    __predict_false(tosp->to_frame <= t->frame)) {
   1815  1.48     skrll 			tosp->xfer->ux_status = USBD_TIMEOUT;
   1816  1.12  kiyohara 			slhci_do_abort(sc, tosp, tosp->xfer);
   1817  1.12  kiyohara 			enter_callback(t, tosp);
   1818  1.12  kiyohara 		}
   1819  1.12  kiyohara 
   1820  1.34     skrll 		/*
   1821  1.34     skrll 		 * Start any waiting transfers right away.  If none, we will
   1822  1.34     skrll 		 * start any new transfers later.
   1823  1.34     skrll 		 */
   1824  1.12  kiyohara 		slhci_tstart(sc);
   1825  1.12  kiyohara 	}
   1826  1.12  kiyohara 
   1827  1.12  kiyohara 	if (r & (SL11_ISR_USBA|SL11_ISR_USBB)) {
   1828  1.12  kiyohara 		int ab;
   1829  1.12  kiyohara 
   1830  1.36     skrll 		if ((r & (SL11_ISR_USBA|SL11_ISR_USBB)) ==
   1831  1.12  kiyohara 		    (SL11_ISR_USBA|SL11_ISR_USBB)) {
   1832  1.12  kiyohara 			if (!(t->flags & (F_AINPROG|F_BINPROG)))
   1833  1.12  kiyohara 				return 1; /* presume card pulled */
   1834  1.12  kiyohara 
   1835  1.36     skrll 			LK_SLASSERT((t->flags & (F_AINPROG|F_BINPROG)) !=
   1836  1.12  kiyohara 			    (F_AINPROG|F_BINPROG), sc, NULL, NULL, return 1);
   1837  1.12  kiyohara 
   1838  1.34     skrll 			/*
   1839  1.34     skrll 			 * This should never happen (unless card removal just
   1840  1.12  kiyohara 			 * occurred) but appeared frequently when both
   1841  1.36     skrll 			 * transfers were started at the same time and was
   1842  1.36     skrll 			 * accompanied by data corruption.  It still happens
   1843  1.36     skrll 			 * at times.  I have not seen data correption except
   1844  1.36     skrll 			 * when the STATUS bit gets set, which now causes the
   1845  1.36     skrll 			 * driver to halt, however this should still not
   1846  1.36     skrll 			 * happen so the warning is kept.  See comment in
   1847  1.12  kiyohara 			 * abdone, below.
   1848  1.12  kiyohara 			 */
   1849  1.12  kiyohara 			printf("%s: Transfer reported done but not started! "
   1850  1.12  kiyohara 			    "Verify data integrity if not detaching. "
   1851  1.12  kiyohara 			    " flags %#x r %x\n", SC_NAME(sc), t->flags, r);
   1852  1.12  kiyohara 
   1853  1.12  kiyohara 			if (!(t->flags & F_AINPROG))
   1854  1.12  kiyohara 				r &= ~SL11_ISR_USBA;
   1855  1.12  kiyohara 			else
   1856  1.12  kiyohara 				r &= ~SL11_ISR_USBB;
   1857  1.12  kiyohara 		}
   1858  1.12  kiyohara 		t->pend = INT_MAX;
   1859  1.12  kiyohara 
   1860  1.12  kiyohara 		if (r & SL11_ISR_USBA)
   1861  1.12  kiyohara 			ab = A;
   1862  1.36     skrll 		else
   1863  1.12  kiyohara 			ab = B;
   1864  1.12  kiyohara 
   1865  1.34     skrll 		/*
   1866  1.34     skrll 		 * This happens when a low speed device is attached to
   1867  1.37     skrll 		 * a hub with chip rev 1.5.  SOF stops, but a few transfers
   1868  1.12  kiyohara 		 * still work before causing this error.
   1869  1.12  kiyohara 		 */
   1870  1.12  kiyohara 		if (!(t->flags & (ab ? F_BINPROG : F_AINPROG))) {
   1871  1.36     skrll 			printf("%s: %s done but not in progress! halted\n",
   1872  1.12  kiyohara 			    SC_NAME(sc), ab ? "B" : "A");
   1873  1.36     skrll 			DDOLOG("%s: %s done but not in progress! halted\n",
   1874  1.12  kiyohara 			    SC_NAME(sc), ab ? "B" : "A", 0,0);
   1875  1.12  kiyohara 			slhci_halt(sc, NULL, NULL);
   1876  1.12  kiyohara 			return 1;
   1877  1.12  kiyohara 		}
   1878  1.12  kiyohara 
   1879  1.12  kiyohara 		t->flags &= ~(ab ? F_BINPROG : F_AINPROG);
   1880  1.12  kiyohara 		slhci_tstart(sc);
   1881  1.12  kiyohara 		stop_cc_time(&t_ab[ab]);
   1882  1.12  kiyohara 		start_cc_time(&t_abdone, t->flags);
   1883  1.12  kiyohara 		slhci_abdone(sc, ab);
   1884  1.12  kiyohara 		stop_cc_time(&t_abdone);
   1885  1.12  kiyohara 	}
   1886  1.12  kiyohara 
   1887  1.12  kiyohara 	slhci_dotransfer(sc);
   1888  1.12  kiyohara 
   1889  1.12  kiyohara 	return 1;
   1890  1.12  kiyohara }
   1891  1.12  kiyohara 
   1892  1.12  kiyohara static void
   1893  1.12  kiyohara slhci_abdone(struct slhci_softc *sc, int ab)
   1894  1.12  kiyohara {
   1895  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   1896  1.12  kiyohara 	struct slhci_transfers *t;
   1897  1.12  kiyohara 	struct slhci_pipe *spipe;
   1898  1.12  kiyohara 	struct usbd_xfer *xfer;
   1899  1.36     skrll 	uint8_t status, buf_start;
   1900  1.12  kiyohara 	uint8_t *target_buf;
   1901  1.12  kiyohara 	unsigned int actlen;
   1902  1.12  kiyohara 	int head;
   1903  1.12  kiyohara 
   1904  1.12  kiyohara 	t = &sc->sc_transfers;
   1905  1.12  kiyohara 
   1906  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   1907  1.12  kiyohara 
   1908  1.12  kiyohara 	DLOG(D_TRACE, "ABDONE flags %#x", t->flags, 0,0,0);
   1909  1.12  kiyohara 
   1910  1.36     skrll 	DLOG(D_MSG, "DONE %s spipe %p len %d xfer %p", ab ? "B" : "A",
   1911  1.36     skrll 	    t->spipe[ab], t->len[ab], t->spipe[ab] ?
   1912  1.12  kiyohara 	    t->spipe[ab]->xfer : NULL);
   1913  1.12  kiyohara 
   1914  1.12  kiyohara 	spipe = t->spipe[ab];
   1915  1.12  kiyohara 
   1916  1.34     skrll 	/*
   1917  1.34     skrll 	 * skip this one if aborted; do not call return from the rest of the
   1918  1.34     skrll 	 * function unless halting, else t->len will not be cleared.
   1919  1.34     skrll 	 */
   1920  1.12  kiyohara 	if (spipe == NULL)
   1921  1.12  kiyohara 		goto done;
   1922  1.12  kiyohara 
   1923  1.12  kiyohara 	t->spipe[ab] = NULL;
   1924  1.12  kiyohara 
   1925  1.12  kiyohara 	xfer = spipe->xfer;
   1926  1.12  kiyohara 
   1927  1.12  kiyohara 	gcq_remove(&spipe->to);
   1928  1.12  kiyohara 
   1929  1.12  kiyohara 	LK_SLASSERT(xfer != NULL, sc, spipe, NULL, return);
   1930  1.12  kiyohara 
   1931  1.12  kiyohara 	status = slhci_read(sc, slhci_tregs[ab][STAT]);
   1932  1.12  kiyohara 
   1933  1.12  kiyohara 	/*
   1934  1.36     skrll 	 * I saw no status or remaining length greater than the requested
   1935  1.36     skrll 	 * length in early driver versions in circumstances I assumed caused
   1936  1.36     skrll 	 * excess power draw.  I am no longer able to reproduce this when
   1937  1.36     skrll 	 * causing excess power draw circumstances.
   1938  1.36     skrll 	 *
   1939  1.36     skrll 	 * Disabling a power check and attaching aue to a keyboard and hub
   1940  1.36     skrll 	 * that is directly attached (to CFU1U, 100mA max, aue 160mA, keyboard
   1941  1.36     skrll 	 * 98mA) sometimes works and sometimes fails to configure.  After
   1942  1.36     skrll 	 * removing the aue and attaching a self-powered umass dvd reader
   1943  1.36     skrll 	 * (unknown if it draws power from the host also) soon a single Error
   1944  1.36     skrll 	 * status occurs then only timeouts. The controller soon halts freeing
   1945  1.36     skrll 	 * memory due to being ONQU instead of BUSY.  This may be the same
   1946  1.36     skrll 	 * basic sequence that caused the no status/bad length errors.  The
   1947  1.36     skrll 	 * umass device seems to work (better at least) with the keyboard hub
   1948  1.36     skrll 	 * when not first attaching aue (tested once reading an approximately
   1949  1.12  kiyohara 	 * 200MB file).
   1950  1.36     skrll 	 *
   1951  1.36     skrll 	 * Overflow can indicate that the device and host disagree about how
   1952  1.36     skrll 	 * much data has been transfered.  This may indicate a problem at any
   1953  1.36     skrll 	 * point during the transfer, not just when the error occurs.  It may
   1954  1.12  kiyohara 	 * indicate data corruption.  A warning message is printed.
   1955  1.12  kiyohara 	 *
   1956  1.36     skrll 	 * Trying to use both A and B transfers at the same time results in
   1957  1.36     skrll 	 * incorrect transfer completion ISR reports and the status will then
   1958  1.36     skrll 	 * include SL11_EPSTAT_SETUP, which is apparently set while the
   1959  1.36     skrll 	 * transfer is in progress.  I also noticed data corruption, even
   1960  1.36     skrll 	 * after waiting for the transfer to complete. The driver now avoids
   1961  1.12  kiyohara 	 * trying to start both at the same time.
   1962  1.12  kiyohara 	 *
   1963  1.36     skrll 	 * I had accidently initialized the B registers before they were valid
   1964  1.36     skrll 	 * in some driver versions.  Since every other performance enhancing
   1965  1.36     skrll 	 * feature has been confirmed buggy in the errata doc, I have not
   1966  1.12  kiyohara 	 * tried both transfers at once again with the documented
   1967  1.12  kiyohara 	 * initialization order.
   1968  1.36     skrll 	 *
   1969  1.36     skrll 	 * However, I have seen this problem again ("done but not started"
   1970  1.36     skrll 	 * errors), which in some cases cases the SETUP status bit to remain
   1971  1.36     skrll 	 * set on future transfers.  In other cases, the SETUP bit is not set
   1972  1.36     skrll 	 * and no data corruption occurs.  This occured while using both umass
   1973  1.36     skrll 	 * and aue on a powered hub (maybe triggered by some local activity
   1974  1.36     skrll 	 * also) and needs several reads of the 200MB file to trigger.  The
   1975  1.12  kiyohara 	 * driver now halts if SETUP is detected.
   1976  1.12  kiyohara  	 */
   1977  1.12  kiyohara 
   1978  1.12  kiyohara 	actlen = 0;
   1979  1.12  kiyohara 
   1980  1.12  kiyohara 	if (__predict_false(!status)) {
   1981  1.12  kiyohara 		DDOLOG("no status! xfer %p spipe %p", xfer, spipe, 0,0);
   1982  1.12  kiyohara 		printf("%s: no status! halted\n", SC_NAME(sc));
   1983  1.12  kiyohara 		slhci_halt(sc, spipe, xfer);
   1984  1.12  kiyohara 		return;
   1985  1.36     skrll 	}
   1986  1.12  kiyohara 
   1987  1.12  kiyohara #ifdef SLHCI_DEBUG
   1988  1.51     skrll 	if (slhcidebug & SLHCI_D_NAK || (status & SL11_EPSTAT_ERRBITS) !=
   1989  1.12  kiyohara 	    SL11_EPSTAT_NAK)
   1990  1.36     skrll 		DLOGFLAG8(D_XFER, "STATUS=", status, "STALL", "NAK",
   1991  1.36     skrll 		    "Overflow", "Setup", "Data Toggle", "Timeout", "Error",
   1992  1.12  kiyohara 		    "ACK");
   1993  1.12  kiyohara #endif
   1994  1.12  kiyohara 
   1995  1.12  kiyohara 	if (!(status & SL11_EPSTAT_ERRBITS)) {
   1996  1.12  kiyohara 		unsigned int cont;
   1997  1.12  kiyohara 		cont = slhci_read(sc, slhci_tregs[ab][CONT]);
   1998  1.12  kiyohara 		if (cont != 0)
   1999  1.36     skrll 			DLOG(D_XFER, "cont %d len %d", cont,
   2000  1.12  kiyohara 			    spipe->tregs[LEN], 0,0);
   2001  1.12  kiyohara 		if (__predict_false(cont > spipe->tregs[LEN])) {
   2002  1.48     skrll 			DDOLOG("cont > len! cont %d len %d xfer->ux_length %d "
   2003  1.48     skrll 			    "spipe %p", cont, spipe->tregs[LEN], xfer->ux_length,
   2004  1.12  kiyohara 			    spipe);
   2005  1.48     skrll 			printf("%s: cont > len! cont %d len %d xfer->ux_length "
   2006  1.36     skrll 			    "%d", SC_NAME(sc), cont, spipe->tregs[LEN],
   2007  1.48     skrll 			    xfer->ux_length);
   2008  1.12  kiyohara 			slhci_halt(sc, spipe, xfer);
   2009  1.12  kiyohara 			return;
   2010  1.12  kiyohara 		} else {
   2011  1.12  kiyohara 			spipe->nerrs = 0;
   2012  1.12  kiyohara 			actlen = spipe->tregs[LEN] - cont;
   2013  1.12  kiyohara 		}
   2014  1.12  kiyohara 	}
   2015  1.12  kiyohara 
   2016  1.12  kiyohara 	/* Actual copyin done after starting next transfer. */
   2017  1.12  kiyohara 	if (actlen && (spipe->tregs[PID] & SL11_PID_BITS) == SL11_PID_IN) {
   2018  1.12  kiyohara 		target_buf = spipe->buffer;
   2019  1.12  kiyohara 		buf_start = spipe->tregs[ADR];
   2020  1.12  kiyohara 	} else {
   2021  1.12  kiyohara 		target_buf = NULL;
   2022  1.12  kiyohara 		buf_start = 0; /* XXX gcc uninitialized warnings */
   2023  1.12  kiyohara 	}
   2024  1.12  kiyohara 
   2025  1.12  kiyohara 	if (status & SL11_EPSTAT_ERRBITS) {
   2026  1.12  kiyohara 		status &= SL11_EPSTAT_ERRBITS;
   2027  1.12  kiyohara 		if (status & SL11_EPSTAT_SETUP) {
   2028  1.12  kiyohara 			printf("%s: Invalid controller state detected! "
   2029  1.12  kiyohara 			    "halted\n", SC_NAME(sc));
   2030  1.12  kiyohara 			DDOLOG("%s: Invalid controller state detected! "
   2031  1.12  kiyohara 			    "halted\n", SC_NAME(sc), 0,0,0);
   2032  1.12  kiyohara 			slhci_halt(sc, spipe, xfer);
   2033  1.12  kiyohara 			return;
   2034  1.48     skrll 		} else if (__predict_false(sc->sc_bus.ub_usepolling)) {
   2035  1.12  kiyohara 			if (status == SL11_EPSTAT_STALL)
   2036  1.48     skrll 				xfer->ux_status = USBD_STALLED;
   2037  1.12  kiyohara 			else if (status == SL11_EPSTAT_TIMEOUT)
   2038  1.48     skrll 				xfer->ux_status = USBD_TIMEOUT;
   2039  1.12  kiyohara 			else if (status == SL11_EPSTAT_NAK)
   2040  1.48     skrll 				xfer->ux_status = USBD_TIMEOUT; /*XXX*/
   2041  1.12  kiyohara 			else
   2042  1.48     skrll 				xfer->ux_status = USBD_IOERROR;
   2043  1.12  kiyohara 			head = Q_CALLBACKS;
   2044  1.12  kiyohara 		} else if (status == SL11_EPSTAT_NAK) {
   2045  1.48     skrll 			if (spipe->pipe.up_interval) {
   2046  1.36     skrll 				spipe->lastframe = spipe->frame =
   2047  1.48     skrll 				    t->frame + spipe->pipe.up_interval;
   2048  1.12  kiyohara 				slhci_queue_timed(sc, spipe);
   2049  1.12  kiyohara 				goto queued;
   2050  1.12  kiyohara 			}
   2051  1.12  kiyohara 			head = Q_NEXT_CB;
   2052  1.36     skrll 		} else if (++spipe->nerrs > SLHCI_MAX_RETRIES ||
   2053  1.12  kiyohara 		    status == SL11_EPSTAT_STALL) {
   2054  1.12  kiyohara 			if (status == SL11_EPSTAT_STALL)
   2055  1.48     skrll 				xfer->ux_status = USBD_STALLED;
   2056  1.12  kiyohara 			else if (status == SL11_EPSTAT_TIMEOUT)
   2057  1.48     skrll 				xfer->ux_status = USBD_TIMEOUT;
   2058  1.12  kiyohara 			else
   2059  1.48     skrll 				xfer->ux_status = USBD_IOERROR;
   2060  1.12  kiyohara 
   2061  1.12  kiyohara 			DLOG(D_ERR, "Max retries reached! status %#x "
   2062  1.48     skrll 			    "xfer->ux_status %#x", status, xfer->ux_status, 0,0);
   2063  1.36     skrll 			DLOGFLAG8(D_ERR, "STATUS=", status, "STALL",
   2064  1.36     skrll 			    "NAK", "Overflow", "Setup", "Data Toggle",
   2065  1.12  kiyohara 			    "Timeout", "Error", "ACK");
   2066  1.12  kiyohara 
   2067  1.12  kiyohara 			if (status == SL11_EPSTAT_OVERFLOW &&
   2068  1.36     skrll 			    ratecheck(&sc->sc_overflow_warn_rate,
   2069  1.12  kiyohara 			    &overflow_warn_rate)) {
   2070  1.12  kiyohara 				printf("%s: Overflow condition: "
   2071  1.36     skrll 				    "data corruption possible\n",
   2072  1.12  kiyohara 				    SC_NAME(sc));
   2073  1.12  kiyohara 				DDOLOG("%s: Overflow condition: "
   2074  1.36     skrll 				    "data corruption possible\n",
   2075  1.12  kiyohara 				    SC_NAME(sc), 0,0,0);
   2076  1.12  kiyohara 			}
   2077  1.12  kiyohara 			head = Q_CALLBACKS;
   2078  1.12  kiyohara 		} else {
   2079  1.12  kiyohara 			head = Q_NEXT_CB;
   2080  1.12  kiyohara 		}
   2081  1.12  kiyohara 	} else if (spipe->ptype == PT_CTRL_SETUP) {
   2082  1.12  kiyohara 		spipe->tregs[PID] = spipe->newpid;
   2083  1.12  kiyohara 
   2084  1.48     skrll 		if (xfer->ux_length) {
   2085  1.36     skrll 			LK_SLASSERT(spipe->newlen[1] != 0, sc, spipe, xfer,
   2086  1.12  kiyohara 			    return);
   2087  1.12  kiyohara 			spipe->tregs[LEN] = spipe->newlen[1];
   2088  1.12  kiyohara 			spipe->bustime = spipe->newbustime[1];
   2089  1.48     skrll 			spipe->buffer = xfer->ux_buf;
   2090  1.12  kiyohara 			spipe->ptype = PT_CTRL_DATA;
   2091  1.12  kiyohara 		} else {
   2092  1.12  kiyohara status_setup:
   2093  1.12  kiyohara 			/* CTRL_DATA swaps direction in PID then jumps here */
   2094  1.12  kiyohara 			spipe->tregs[LEN] = 0;
   2095  1.12  kiyohara 			if (spipe->pflags & PF_LS)
   2096  1.12  kiyohara 				spipe->bustime = SLHCI_LS_CONST;
   2097  1.12  kiyohara 			else
   2098  1.12  kiyohara 				spipe->bustime = SLHCI_FS_CONST;
   2099  1.12  kiyohara 			spipe->ptype = PT_CTRL_STATUS;
   2100  1.12  kiyohara 			spipe->buffer = NULL;
   2101  1.12  kiyohara 		}
   2102  1.12  kiyohara 
   2103  1.12  kiyohara 		/* Status or first data packet must be DATA1. */
   2104  1.12  kiyohara 		spipe->control |= SL11_EPCTRL_DATATOGGLE;
   2105  1.12  kiyohara 		if ((spipe->tregs[PID] & SL11_PID_BITS) == SL11_PID_IN)
   2106  1.12  kiyohara 			spipe->control &= ~SL11_EPCTRL_DIRECTION;
   2107  1.36     skrll 		else
   2108  1.12  kiyohara 			spipe->control |= SL11_EPCTRL_DIRECTION;
   2109  1.12  kiyohara 
   2110  1.12  kiyohara 		head = Q_CB;
   2111  1.12  kiyohara 	} else if (spipe->ptype == PT_CTRL_STATUS) {
   2112  1.12  kiyohara 		head = Q_CALLBACKS;
   2113  1.12  kiyohara 	} else { /* bulk, intr, control data */
   2114  1.48     skrll 		xfer->ux_actlen += actlen;
   2115  1.12  kiyohara 		spipe->control ^= SL11_EPCTRL_DATATOGGLE;
   2116  1.12  kiyohara 
   2117  1.48     skrll 		if (actlen == spipe->tregs[LEN] && (xfer->ux_length >
   2118  1.48     skrll 		    xfer->ux_actlen || spipe->wantshort)) {
   2119  1.12  kiyohara 			spipe->buffer += actlen;
   2120  1.48     skrll 			LK_SLASSERT(xfer->ux_length >= xfer->ux_actlen, sc,
   2121  1.12  kiyohara 			    spipe, xfer, return);
   2122  1.48     skrll 			if (xfer->ux_length - xfer->ux_actlen < actlen) {
   2123  1.12  kiyohara 				spipe->wantshort = 0;
   2124  1.12  kiyohara 				spipe->tregs[LEN] = spipe->newlen[0];
   2125  1.12  kiyohara 				spipe->bustime = spipe->newbustime[0];
   2126  1.48     skrll 				LK_SLASSERT(xfer->ux_actlen +
   2127  1.48     skrll 				    spipe->tregs[LEN] == xfer->ux_length, sc,
   2128  1.12  kiyohara 				    spipe, xfer, return);
   2129  1.12  kiyohara 			}
   2130  1.12  kiyohara 			head = Q_CB;
   2131  1.12  kiyohara 		} else if (spipe->ptype == PT_CTRL_DATA) {
   2132  1.12  kiyohara 			spipe->tregs[PID] ^= SLHCI_PID_SWAP_IN_OUT;
   2133  1.12  kiyohara 			goto status_setup;
   2134  1.12  kiyohara 		} else {
   2135  1.12  kiyohara 			if (spipe->ptype == PT_INTR) {
   2136  1.36     skrll 				spipe->lastframe +=
   2137  1.48     skrll 				    spipe->pipe.up_interval;
   2138  1.34     skrll 				/*
   2139  1.34     skrll 				 * If ack, we try to keep the
   2140  1.37     skrll 				 * interrupt rate by using lastframe
   2141  1.34     skrll 				 * instead of the current frame.
   2142  1.34     skrll 				 */
   2143  1.12  kiyohara 				spipe->frame = spipe->lastframe +
   2144  1.48     skrll 				    spipe->pipe.up_interval;
   2145  1.12  kiyohara 			}
   2146  1.12  kiyohara 
   2147  1.34     skrll 			/*
   2148  1.34     skrll 			 * Set the toggle for the next transfer.  It
   2149  1.37     skrll 			 * has already been toggled above, so the
   2150  1.37     skrll 			 * current setting will apply to the next
   2151  1.34     skrll 			 * transfer.
   2152  1.34     skrll 			 */
   2153  1.12  kiyohara 			if (spipe->control & SL11_EPCTRL_DATATOGGLE)
   2154  1.12  kiyohara 				spipe->pflags |= PF_TOGGLE;
   2155  1.12  kiyohara 			else
   2156  1.12  kiyohara 				spipe->pflags &= ~PF_TOGGLE;
   2157  1.12  kiyohara 
   2158  1.12  kiyohara 			head = Q_CALLBACKS;
   2159  1.12  kiyohara 		}
   2160  1.12  kiyohara 	}
   2161  1.12  kiyohara 
   2162  1.12  kiyohara 	if (head == Q_CALLBACKS) {
   2163  1.12  kiyohara 		gcq_remove(&spipe->to);
   2164  1.12  kiyohara 
   2165  1.48     skrll 	 	if (xfer->ux_status == USBD_IN_PROGRESS) {
   2166  1.48     skrll 			LK_SLASSERT(xfer->ux_actlen <= xfer->ux_length, sc,
   2167  1.12  kiyohara 			    spipe, xfer, return);
   2168  1.48     skrll 			xfer->ux_status = USBD_NORMAL_COMPLETION;
   2169  1.12  kiyohara #if 0 /* usb_transfer_complete will do this */
   2170  1.48     skrll 			if (xfer->ux_length == xfer->ux_actlen || xfer->ux_flags &
   2171  1.12  kiyohara 			    USBD_SHORT_XFER_OK)
   2172  1.48     skrll 				xfer->ux_status = USBD_NORMAL_COMPLETION;
   2173  1.12  kiyohara 			else
   2174  1.48     skrll 				xfer->ux_status = USBD_SHORT_XFER;
   2175  1.12  kiyohara #endif
   2176  1.12  kiyohara 		}
   2177  1.12  kiyohara 	}
   2178  1.12  kiyohara 
   2179  1.12  kiyohara 	enter_q(t, spipe, head);
   2180  1.12  kiyohara 
   2181  1.12  kiyohara queued:
   2182  1.12  kiyohara 	if (target_buf != NULL) {
   2183  1.12  kiyohara 		slhci_dotransfer(sc);
   2184  1.12  kiyohara 		start_cc_time(&t_copy_from_dev, actlen);
   2185  1.12  kiyohara 		slhci_read_multi(sc, buf_start, target_buf, actlen);
   2186  1.12  kiyohara 		stop_cc_time(&t_copy_from_dev);
   2187  1.12  kiyohara 		DLOGBUF(D_BUF, target_buf, actlen);
   2188  1.12  kiyohara 		t->pend -= SLHCI_FS_CONST + SLHCI_FS_DATA_TIME(actlen);
   2189  1.12  kiyohara 	}
   2190  1.12  kiyohara 
   2191  1.12  kiyohara done:
   2192  1.12  kiyohara 	t->len[ab] = -1;
   2193  1.12  kiyohara }
   2194  1.12  kiyohara 
   2195  1.12  kiyohara static void
   2196  1.12  kiyohara slhci_tstart(struct slhci_softc *sc)
   2197  1.12  kiyohara {
   2198  1.12  kiyohara 	struct slhci_transfers *t;
   2199  1.12  kiyohara 	struct slhci_pipe *spipe;
   2200  1.12  kiyohara 	int remaining_bustime;
   2201  1.12  kiyohara 
   2202  1.12  kiyohara 	t = &sc->sc_transfers;
   2203  1.12  kiyohara 
   2204  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2205  1.12  kiyohara 
   2206  1.12  kiyohara 	if (!(t->flags & (F_AREADY|F_BREADY)))
   2207  1.12  kiyohara 		return;
   2208  1.12  kiyohara 
   2209  1.12  kiyohara 	if (t->flags & (F_AINPROG|F_BINPROG|F_DISABLED))
   2210  1.12  kiyohara 		return;
   2211  1.12  kiyohara 
   2212  1.34     skrll 	/*
   2213  1.34     skrll 	 * We have about 6 us to get from the bus time check to
   2214  1.37     skrll 	 * starting the transfer or we might babble or the chip might fail to
   2215  1.37     skrll 	 * signal transfer complete.  This leaves no time for any other
   2216  1.25     rmind 	 * interrupts.
   2217  1.25     rmind 	 */
   2218  1.12  kiyohara 	remaining_bustime = (int)(slhci_read(sc, SL811_CSOF)) << 6;
   2219  1.12  kiyohara 	remaining_bustime -= SLHCI_END_BUSTIME;
   2220  1.12  kiyohara 
   2221  1.34     skrll 	/*
   2222  1.34     skrll 	 * Start one transfer only, clearing any aborted transfers that are
   2223  1.37     skrll 	 * not yet in progress and skipping missed isoc. It is easier to copy
   2224  1.37     skrll 	 * & paste most of the A/B sections than to make the logic work
   2225  1.34     skrll 	 * otherwise and this allows better constant use.
   2226  1.34     skrll 	 */
   2227  1.12  kiyohara 	if (t->flags & F_AREADY) {
   2228  1.12  kiyohara 		spipe = t->spipe[A];
   2229  1.12  kiyohara 		if (spipe == NULL) {
   2230  1.12  kiyohara 			t->flags &= ~F_AREADY;
   2231  1.12  kiyohara 			t->len[A] = -1;
   2232  1.12  kiyohara 		} else if (remaining_bustime >= spipe->bustime) {
   2233  1.12  kiyohara 			t->flags &= ~(F_AREADY|F_SOFCHECK1|F_SOFCHECK2);
   2234  1.12  kiyohara 			t->flags |= F_AINPROG;
   2235  1.12  kiyohara 			start_cc_time(&t_ab[A], spipe->tregs[LEN]);
   2236  1.12  kiyohara 			slhci_write(sc, SL11_E0CTRL, spipe->control);
   2237  1.12  kiyohara 			goto pend;
   2238  1.36     skrll 		}
   2239  1.12  kiyohara 	}
   2240  1.12  kiyohara 	if (t->flags & F_BREADY) {
   2241  1.12  kiyohara 		spipe = t->spipe[B];
   2242  1.12  kiyohara 		if (spipe == NULL) {
   2243  1.12  kiyohara 			t->flags &= ~F_BREADY;
   2244  1.12  kiyohara 			t->len[B] = -1;
   2245  1.12  kiyohara 		} else if (remaining_bustime >= spipe->bustime) {
   2246  1.12  kiyohara 			t->flags &= ~(F_BREADY|F_SOFCHECK1|F_SOFCHECK2);
   2247  1.12  kiyohara 			t->flags |= F_BINPROG;
   2248  1.12  kiyohara 			start_cc_time(&t_ab[B], spipe->tregs[LEN]);
   2249  1.12  kiyohara 			slhci_write(sc, SL11_E1CTRL, spipe->control);
   2250  1.12  kiyohara pend:
   2251  1.12  kiyohara 			t->pend = spipe->bustime;
   2252  1.12  kiyohara 		}
   2253  1.12  kiyohara 	}
   2254  1.12  kiyohara }
   2255  1.12  kiyohara 
   2256  1.12  kiyohara static void
   2257  1.12  kiyohara slhci_dotransfer(struct slhci_softc *sc)
   2258  1.12  kiyohara {
   2259  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2260  1.12  kiyohara 	struct slhci_transfers *t;
   2261  1.12  kiyohara 	struct slhci_pipe *spipe;
   2262  1.12  kiyohara 	int ab, i;
   2263  1.12  kiyohara 
   2264  1.12  kiyohara 	t = &sc->sc_transfers;
   2265  1.12  kiyohara 
   2266  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2267  1.12  kiyohara 
   2268  1.12  kiyohara  	while ((t->len[A] == -1 || t->len[B] == -1) &&
   2269  1.36     skrll 	    (GOT_FIRST_TIMED_COND(spipe, t, spipe->frame <= t->frame) ||
   2270  1.12  kiyohara 	    GOT_FIRST_CB(spipe, t))) {
   2271  1.12  kiyohara 		LK_SLASSERT(spipe->xfer != NULL, sc, spipe, NULL, return);
   2272  1.36     skrll 		LK_SLASSERT(spipe->ptype != PT_ROOT_CTRL && spipe->ptype !=
   2273  1.36     skrll 		    PT_ROOT_INTR, sc, spipe, NULL, return);
   2274  1.36     skrll 
   2275  1.36     skrll 		/* Check that this transfer can fit in the remaining memory. */
   2276  1.37     skrll 		if (t->len[A] + t->len[B] + spipe->tregs[LEN] + 1 >
   2277  1.12  kiyohara 		    SL11_MAX_PACKET_SIZE) {
   2278  1.12  kiyohara 			DLOG(D_XFER, "Transfer does not fit. alen %d blen %d "
   2279  1.37     skrll 			    "len %d", t->len[A], t->len[B], spipe->tregs[LEN],
   2280  1.12  kiyohara 			    0);
   2281  1.12  kiyohara 			return;
   2282  1.12  kiyohara 		}
   2283  1.12  kiyohara 
   2284  1.12  kiyohara 		gcq_remove(&spipe->xq);
   2285  1.12  kiyohara 
   2286  1.12  kiyohara 		if (t->len[A] == -1) {
   2287  1.12  kiyohara 			ab = A;
   2288  1.12  kiyohara 			spipe->tregs[ADR] = SL11_BUFFER_START;
   2289  1.12  kiyohara 		} else {
   2290  1.12  kiyohara 			ab = B;
   2291  1.37     skrll 			spipe->tregs[ADR] = SL11_BUFFER_END -
   2292  1.12  kiyohara 			    spipe->tregs[LEN];
   2293  1.12  kiyohara 		}
   2294  1.12  kiyohara 
   2295  1.12  kiyohara 		t->len[ab] = spipe->tregs[LEN];
   2296  1.12  kiyohara 
   2297  1.37     skrll 		if (spipe->tregs[LEN] && (spipe->tregs[PID] & SL11_PID_BITS)
   2298  1.12  kiyohara 		    != SL11_PID_IN) {
   2299  1.37     skrll 			start_cc_time(&t_copy_to_dev,
   2300  1.12  kiyohara 			    spipe->tregs[LEN]);
   2301  1.37     skrll 			slhci_write_multi(sc, spipe->tregs[ADR],
   2302  1.12  kiyohara 			    spipe->buffer, spipe->tregs[LEN]);
   2303  1.12  kiyohara 			stop_cc_time(&t_copy_to_dev);
   2304  1.37     skrll 			t->pend -= SLHCI_FS_CONST +
   2305  1.12  kiyohara 			    SLHCI_FS_DATA_TIME(spipe->tregs[LEN]);
   2306  1.12  kiyohara 		}
   2307  1.12  kiyohara 
   2308  1.37     skrll 		DLOG(D_MSG, "NEW TRANSFER %s flags %#x alen %d blen %d",
   2309  1.12  kiyohara 		    ab ? "B" : "A", t->flags, t->len[0], t->len[1]);
   2310  1.12  kiyohara 
   2311  1.12  kiyohara 		if (spipe->tregs[LEN])
   2312  1.12  kiyohara 			i = 0;
   2313  1.12  kiyohara 		else
   2314  1.12  kiyohara 			i = 1;
   2315  1.12  kiyohara 
   2316  1.12  kiyohara 		for (; i <= 3; i++)
   2317  1.12  kiyohara 			if (t->current_tregs[ab][i] != spipe->tregs[i]) {
   2318  1.12  kiyohara 				t->current_tregs[ab][i] = spipe->tregs[i];
   2319  1.37     skrll 				slhci_write(sc, slhci_tregs[ab][i],
   2320  1.12  kiyohara 				    spipe->tregs[i]);
   2321  1.12  kiyohara 			}
   2322  1.12  kiyohara 
   2323  1.37     skrll 		DLOG(D_SXFER, "Transfer len %d pid %#x dev %d type %s",
   2324  1.37     skrll 		    spipe->tregs[LEN], spipe->tregs[PID], spipe->tregs[DEV],
   2325  1.12  kiyohara 	    	    pnames(spipe->ptype));
   2326  1.12  kiyohara 
   2327  1.12  kiyohara 		t->spipe[ab] = spipe;
   2328  1.12  kiyohara 		t->flags |= ab ? F_BREADY : F_AREADY;
   2329  1.12  kiyohara 
   2330  1.12  kiyohara 		slhci_tstart(sc);
   2331  1.12  kiyohara 	}
   2332  1.12  kiyohara }
   2333  1.12  kiyohara 
   2334  1.34     skrll /*
   2335  1.34     skrll  * slhci_callback is called after the lock is taken from splusb.
   2336  1.34     skrll  */
   2337  1.12  kiyohara static void
   2338  1.41     skrll slhci_callback(struct slhci_softc *sc)
   2339  1.12  kiyohara {
   2340  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2341  1.12  kiyohara 	struct slhci_transfers *t;
   2342  1.12  kiyohara 	struct slhci_pipe *spipe;
   2343  1.12  kiyohara 	struct usbd_xfer *xfer;
   2344  1.12  kiyohara 
   2345  1.12  kiyohara 	t = &sc->sc_transfers;
   2346  1.12  kiyohara 
   2347  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2348  1.12  kiyohara 
   2349  1.12  kiyohara 	DLOG(D_SOFT, "CB flags %#x", t->flags, 0,0,0);
   2350  1.12  kiyohara 	for (;;) {
   2351  1.12  kiyohara 		if (__predict_false(t->flags & F_ROOTINTR)) {
   2352  1.12  kiyohara 			t->flags &= ~F_ROOTINTR;
   2353  1.12  kiyohara 			if (t->rootintr != NULL) {
   2354  1.12  kiyohara 				u_char *p;
   2355  1.12  kiyohara 
   2356  1.48     skrll 				p = t->rootintr->ux_buf;
   2357  1.12  kiyohara 				p[0] = 2;
   2358  1.48     skrll 				t->rootintr->ux_actlen = 1;
   2359  1.48     skrll 				t->rootintr->ux_status = USBD_NORMAL_COMPLETION;
   2360  1.12  kiyohara 				xfer = t->rootintr;
   2361  1.12  kiyohara 				goto do_callback;
   2362  1.12  kiyohara 			}
   2363  1.37     skrll 		}
   2364  1.12  kiyohara 
   2365  1.12  kiyohara 
   2366  1.12  kiyohara 		if (!DEQUEUED_CALLBACK(spipe, t))
   2367  1.12  kiyohara 			return;
   2368  1.12  kiyohara 
   2369  1.12  kiyohara 		xfer = spipe->xfer;
   2370  1.12  kiyohara 		LK_SLASSERT(xfer != NULL, sc, spipe, NULL, return);
   2371  1.12  kiyohara 		spipe->xfer = NULL;
   2372  1.12  kiyohara 		DLOG(D_XFER, "xfer callback length %d actlen %d spipe %x "
   2373  1.48     skrll 		    "type %s", xfer->ux_length, xfer->ux_actlen, spipe,
   2374  1.12  kiyohara 		    pnames(spipe->ptype));
   2375  1.12  kiyohara do_callback:
   2376  1.41     skrll 		slhci_do_callback(sc, xfer);
   2377  1.12  kiyohara 	}
   2378  1.12  kiyohara }
   2379  1.12  kiyohara 
   2380  1.12  kiyohara static void
   2381  1.12  kiyohara slhci_enter_xfer(struct slhci_softc *sc, struct slhci_pipe *spipe)
   2382  1.12  kiyohara {
   2383  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2384  1.12  kiyohara 	struct slhci_transfers *t;
   2385  1.12  kiyohara 
   2386  1.12  kiyohara 	t = &sc->sc_transfers;
   2387  1.12  kiyohara 
   2388  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2389  1.12  kiyohara 
   2390  1.37     skrll 	if (__predict_false(t->flags & F_DISABLED) ||
   2391  1.12  kiyohara 	    __predict_false(spipe->pflags & PF_GONE)) {
   2392  1.12  kiyohara 		DLOG(D_MSG, "slhci_enter_xfer: DISABLED or GONE", 0,0,0,0);
   2393  1.48     skrll 		spipe->xfer->ux_status = USBD_CANCELLED;
   2394  1.12  kiyohara 	}
   2395  1.12  kiyohara 
   2396  1.48     skrll 	if (spipe->xfer->ux_status == USBD_IN_PROGRESS) {
   2397  1.48     skrll 		if (spipe->xfer->ux_timeout) {
   2398  1.48     skrll 			spipe->to_frame = t->frame + spipe->xfer->ux_timeout;
   2399  1.37     skrll 			slhci_xfer_timer(sc, spipe);
   2400  1.12  kiyohara 		}
   2401  1.48     skrll 		if (spipe->pipe.up_interval)
   2402  1.12  kiyohara 			slhci_queue_timed(sc, spipe);
   2403  1.12  kiyohara 		else
   2404  1.12  kiyohara 			enter_q(t, spipe, Q_CB);
   2405  1.12  kiyohara 	} else
   2406  1.12  kiyohara 		enter_callback(t, spipe);
   2407  1.12  kiyohara }
   2408  1.12  kiyohara 
   2409  1.12  kiyohara static void
   2410  1.12  kiyohara slhci_enter_xfers(struct slhci_softc *sc)
   2411  1.12  kiyohara {
   2412  1.12  kiyohara 	struct slhci_pipe *spipe;
   2413  1.12  kiyohara 
   2414  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2415  1.12  kiyohara 
   2416  1.12  kiyohara 	while (DEQUEUED_WAITQ(spipe, sc))
   2417  1.12  kiyohara 		slhci_enter_xfer(sc, spipe);
   2418  1.12  kiyohara }
   2419  1.12  kiyohara 
   2420  1.12  kiyohara static void
   2421  1.12  kiyohara slhci_queue_timed(struct slhci_softc *sc, struct slhci_pipe *spipe)
   2422  1.12  kiyohara {
   2423  1.12  kiyohara 	struct slhci_transfers *t;
   2424  1.12  kiyohara 	struct gcq *q;
   2425  1.12  kiyohara 	struct slhci_pipe *spp;
   2426  1.12  kiyohara 
   2427  1.12  kiyohara 	t = &sc->sc_transfers;
   2428  1.12  kiyohara 
   2429  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2430  1.12  kiyohara 
   2431  1.12  kiyohara 	FIND_TIMED(q, t, spp, spp->frame > spipe->frame);
   2432  1.12  kiyohara 	gcq_insert_before(q, &spipe->xq);
   2433  1.12  kiyohara }
   2434  1.12  kiyohara 
   2435  1.12  kiyohara static void
   2436  1.12  kiyohara slhci_xfer_timer(struct slhci_softc *sc, struct slhci_pipe *spipe)
   2437  1.12  kiyohara {
   2438  1.12  kiyohara 	struct slhci_transfers *t;
   2439  1.12  kiyohara 	struct gcq *q;
   2440  1.12  kiyohara 	struct slhci_pipe *spp;
   2441  1.12  kiyohara 
   2442  1.12  kiyohara 	t = &sc->sc_transfers;
   2443  1.12  kiyohara 
   2444  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2445  1.12  kiyohara 
   2446  1.12  kiyohara 	FIND_TO(q, t, spp, spp->to_frame >= spipe->to_frame);
   2447  1.12  kiyohara 	gcq_insert_before(q, &spipe->to);
   2448  1.12  kiyohara }
   2449  1.12  kiyohara 
   2450  1.12  kiyohara static void
   2451  1.12  kiyohara slhci_callback_schedule(struct slhci_softc *sc)
   2452  1.12  kiyohara {
   2453  1.63     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2454  1.12  kiyohara 	struct slhci_transfers *t;
   2455  1.12  kiyohara 
   2456  1.12  kiyohara 	t = &sc->sc_transfers;
   2457  1.12  kiyohara 
   2458  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2459  1.12  kiyohara 
   2460  1.12  kiyohara 	if (t->flags & F_ACTIVE)
   2461  1.12  kiyohara 		slhci_do_callback_schedule(sc);
   2462  1.12  kiyohara }
   2463  1.12  kiyohara 
   2464  1.12  kiyohara static void
   2465  1.12  kiyohara slhci_do_callback_schedule(struct slhci_softc *sc)
   2466  1.12  kiyohara {
   2467  1.59     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2468  1.12  kiyohara 	struct slhci_transfers *t;
   2469  1.12  kiyohara 
   2470  1.12  kiyohara 	t = &sc->sc_transfers;
   2471  1.12  kiyohara 
   2472  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2473  1.12  kiyohara 
   2474  1.59     skrll 	DLOG(D_MSG, "flags %#x", t->flags, 0, 0, 0);
   2475  1.12  kiyohara 	if (!(t->flags & F_CALLBACK)) {
   2476  1.12  kiyohara 		t->flags |= F_CALLBACK;
   2477  1.16        ad 		softint_schedule(sc->sc_cb_softintr);
   2478  1.12  kiyohara 	}
   2479  1.12  kiyohara }
   2480  1.12  kiyohara 
   2481  1.12  kiyohara #if 0
   2482  1.41     skrll /* must be called with lock taken from IPL_USB */
   2483  1.12  kiyohara /* XXX static */ void
   2484  1.41     skrll slhci_pollxfer(struct slhci_softc *sc, struct usbd_xfer *xfer)
   2485  1.12  kiyohara {
   2486  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2487  1.12  kiyohara 	slhci_dotransfer(sc);
   2488  1.12  kiyohara 	do {
   2489  1.12  kiyohara 		slhci_dointr(sc);
   2490  1.48     skrll 	} while (xfer->ux_status == USBD_IN_PROGRESS);
   2491  1.41     skrll 	slhci_do_callback(sc, xfer);
   2492  1.12  kiyohara }
   2493  1.12  kiyohara #endif
   2494  1.12  kiyohara 
   2495  1.12  kiyohara static usbd_status
   2496  1.37     skrll slhci_do_poll(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2497  1.12  kiyohara     usbd_xfer *xfer)
   2498  1.12  kiyohara {
   2499  1.12  kiyohara 	slhci_waitintr(sc, 0);
   2500  1.12  kiyohara 
   2501  1.12  kiyohara 	return USBD_NORMAL_COMPLETION;
   2502  1.12  kiyohara }
   2503  1.12  kiyohara 
   2504  1.12  kiyohara static usbd_status
   2505  1.37     skrll slhci_lsvh_warn(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2506  1.12  kiyohara     usbd_xfer *xfer)
   2507  1.12  kiyohara {
   2508  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2509  1.12  kiyohara 	struct slhci_transfers *t;
   2510  1.12  kiyohara 
   2511  1.12  kiyohara 	t = &sc->sc_transfers;
   2512  1.12  kiyohara 
   2513  1.12  kiyohara 	if (!(t->flags & F_LSVH_WARNED)) {
   2514  1.12  kiyohara 		printf("%s: Low speed device via hub disabled, "
   2515  1.12  kiyohara 		    "see slhci(4)\n", SC_NAME(sc));
   2516  1.12  kiyohara 		DDOLOG("%s: Low speed device via hub disabled, "
   2517  1.12  kiyohara 		    "see slhci(4)\n", SC_NAME(sc), 0,0,0);
   2518  1.12  kiyohara 		t->flags |= F_LSVH_WARNED;
   2519  1.12  kiyohara 	}
   2520  1.12  kiyohara 	return USBD_INVAL;
   2521  1.12  kiyohara }
   2522  1.12  kiyohara 
   2523  1.12  kiyohara static usbd_status
   2524  1.37     skrll slhci_isoc_warn(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2525  1.12  kiyohara     usbd_xfer *xfer)
   2526  1.12  kiyohara {
   2527  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2528  1.12  kiyohara 	struct slhci_transfers *t;
   2529  1.12  kiyohara 
   2530  1.12  kiyohara 	t = &sc->sc_transfers;
   2531  1.12  kiyohara 
   2532  1.12  kiyohara 	if (!(t->flags & F_ISOC_WARNED)) {
   2533  1.12  kiyohara 		printf("%s: ISOC transfer not supported "
   2534  1.12  kiyohara 		    "(see slhci(4))\n", SC_NAME(sc));
   2535  1.12  kiyohara 		DDOLOG("%s: ISOC transfer not supported "
   2536  1.12  kiyohara 		    "(see slhci(4))\n", SC_NAME(sc), 0,0,0);
   2537  1.12  kiyohara 		t->flags |= F_ISOC_WARNED;
   2538  1.12  kiyohara 	}
   2539  1.12  kiyohara 	return USBD_INVAL;
   2540  1.12  kiyohara }
   2541  1.12  kiyohara 
   2542  1.12  kiyohara static usbd_status
   2543  1.37     skrll slhci_open_pipe(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2544  1.12  kiyohara     usbd_xfer *xfer)
   2545  1.12  kiyohara {
   2546  1.12  kiyohara 	struct slhci_transfers *t;
   2547  1.12  kiyohara 	struct usbd_pipe *pipe;
   2548  1.12  kiyohara 
   2549  1.12  kiyohara 	t = &sc->sc_transfers;
   2550  1.12  kiyohara 	pipe = &spipe->pipe;
   2551  1.12  kiyohara 
   2552  1.12  kiyohara 	if (t->flags & F_DISABLED)
   2553  1.12  kiyohara 		return USBD_CANCELLED;
   2554  1.48     skrll 	else if (pipe->up_interval && !slhci_reserve_bustime(sc, spipe, 1))
   2555  1.12  kiyohara 		return USBD_PENDING_REQUESTS;
   2556  1.12  kiyohara 	else {
   2557  1.12  kiyohara 		enter_all_pipes(t, spipe);
   2558  1.12  kiyohara 		return USBD_NORMAL_COMPLETION;
   2559  1.12  kiyohara 	}
   2560  1.12  kiyohara }
   2561  1.12  kiyohara 
   2562  1.12  kiyohara static usbd_status
   2563  1.37     skrll slhci_close_pipe(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2564  1.12  kiyohara     usbd_xfer *xfer)
   2565  1.12  kiyohara {
   2566  1.12  kiyohara 	struct usbd_pipe *pipe;
   2567  1.12  kiyohara 
   2568  1.12  kiyohara 	pipe = &spipe->pipe;
   2569  1.12  kiyohara 
   2570  1.48     skrll 	if (pipe->up_interval && spipe->ptype != PT_ROOT_INTR)
   2571  1.12  kiyohara 		slhci_reserve_bustime(sc, spipe, 0);
   2572  1.12  kiyohara 	gcq_remove(&spipe->ap);
   2573  1.12  kiyohara 	return USBD_NORMAL_COMPLETION;
   2574  1.12  kiyohara }
   2575  1.12  kiyohara 
   2576  1.12  kiyohara static usbd_status
   2577  1.37     skrll slhci_do_abort(struct slhci_softc *sc, struct slhci_pipe *spipe, struct
   2578  1.12  kiyohara     usbd_xfer *xfer)
   2579  1.12  kiyohara {
   2580  1.12  kiyohara 	struct slhci_transfers *t;
   2581  1.12  kiyohara 
   2582  1.12  kiyohara 	t = &sc->sc_transfers;
   2583  1.12  kiyohara 
   2584  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2585  1.12  kiyohara 
   2586  1.12  kiyohara 	if (spipe->xfer == xfer) {
   2587  1.12  kiyohara 		if (spipe->ptype == PT_ROOT_INTR) {
   2588  1.12  kiyohara 			if (t->rootintr == spipe->xfer) /* XXX assert? */
   2589  1.12  kiyohara 				t->rootintr = NULL;
   2590  1.12  kiyohara 		} else {
   2591  1.12  kiyohara 			gcq_remove(&spipe->to);
   2592  1.12  kiyohara 			gcq_remove(&spipe->xq);
   2593  1.12  kiyohara 
   2594  1.12  kiyohara 			if (t->spipe[A] == spipe) {
   2595  1.12  kiyohara 				t->spipe[A] = NULL;
   2596  1.12  kiyohara 				if (!(t->flags & F_AINPROG))
   2597  1.12  kiyohara 					t->len[A] = -1;
   2598  1.12  kiyohara 			} else if (t->spipe[B] == spipe) {
   2599  1.12  kiyohara 					t->spipe[B] = NULL;
   2600  1.12  kiyohara 				if (!(t->flags & F_BINPROG))
   2601  1.12  kiyohara 					t->len[B] = -1;
   2602  1.12  kiyohara 			}
   2603  1.12  kiyohara 		}
   2604  1.12  kiyohara 
   2605  1.48     skrll 		if (xfer->ux_status != USBD_TIMEOUT) {
   2606  1.12  kiyohara 			spipe->xfer = NULL;
   2607  1.48     skrll 			spipe->pipe.up_repeat = 0; /* XXX timeout? */
   2608  1.12  kiyohara 		}
   2609  1.12  kiyohara 	}
   2610  1.12  kiyohara 
   2611  1.12  kiyohara 	return USBD_NORMAL_COMPLETION;
   2612  1.12  kiyohara }
   2613  1.12  kiyohara 
   2614  1.34     skrll /*
   2615  1.41     skrll  * Called to deactivate or stop use of the controller instead of panicking.
   2616  1.12  kiyohara  * Will cancel the xfer correctly even when not on a list.
   2617  1.12  kiyohara  */
   2618  1.12  kiyohara static usbd_status
   2619  1.48     skrll slhci_halt(struct slhci_softc *sc, struct slhci_pipe *spipe,
   2620  1.48     skrll     struct usbd_xfer *xfer)
   2621  1.12  kiyohara {
   2622  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2623  1.12  kiyohara 	struct slhci_transfers *t;
   2624  1.12  kiyohara 
   2625  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2626  1.12  kiyohara 
   2627  1.12  kiyohara 	t = &sc->sc_transfers;
   2628  1.12  kiyohara 
   2629  1.12  kiyohara 	DDOLOG("Halt! sc %p spipe %p xfer %p", sc, spipe, xfer, 0);
   2630  1.12  kiyohara 
   2631  1.12  kiyohara 	if (spipe != NULL)
   2632  1.12  kiyohara 		slhci_log_spipe(spipe);
   2633  1.12  kiyohara 
   2634  1.12  kiyohara 	if (xfer != NULL)
   2635  1.12  kiyohara 		slhci_log_xfer(xfer);
   2636  1.12  kiyohara 
   2637  1.37     skrll 	if (spipe != NULL && xfer != NULL && spipe->xfer == xfer &&
   2638  1.37     skrll 	    !gcq_onlist(&spipe->xq) && t->spipe[A] != spipe && t->spipe[B] !=
   2639  1.12  kiyohara 	    spipe) {
   2640  1.48     skrll 		xfer->ux_status = USBD_CANCELLED;
   2641  1.12  kiyohara 		enter_callback(t, spipe);
   2642  1.12  kiyohara 	}
   2643  1.12  kiyohara 
   2644  1.12  kiyohara 	if (t->flags & F_ACTIVE) {
   2645  1.12  kiyohara 		slhci_intrchange(sc, 0);
   2646  1.34     skrll 		/*
   2647  1.34     skrll 		 * leave power on when halting in case flash devices or disks
   2648  1.37     skrll 		 * are attached, which may be writing and could be damaged
   2649  1.37     skrll 		 * by abrupt power loss.  The root hub clear power feature
   2650  1.12  kiyohara 		 * should still work after halting.
   2651  1.12  kiyohara 		 */
   2652  1.12  kiyohara 	}
   2653  1.12  kiyohara 
   2654  1.12  kiyohara 	t->flags &= ~F_ACTIVE;
   2655  1.12  kiyohara 	t->flags |= F_UDISABLED;
   2656  1.12  kiyohara 	if (!(t->flags & F_NODEV))
   2657  1.12  kiyohara 		t->flags |= F_NODEV|F_CCONNECT|F_ROOTINTR;
   2658  1.12  kiyohara 	slhci_drain(sc);
   2659   1.1     isaki 
   2660  1.12  kiyohara 	/* One last callback for the drain and device removal. */
   2661  1.12  kiyohara 	slhci_do_callback_schedule(sc);
   2662   1.1     isaki 
   2663  1.12  kiyohara 	return USBD_NORMAL_COMPLETION;
   2664   1.1     isaki }
   2665   1.1     isaki 
   2666  1.34     skrll /*
   2667  1.34     skrll  * There are three interrupt states: no interrupts during reset and after
   2668  1.37     skrll  * device deactivation, INSERT only for no device present but power on, and
   2669  1.12  kiyohara  * SOF, INSERT, ADONE, and BDONE when device is present.
   2670  1.12  kiyohara  */
   2671   1.1     isaki static void
   2672  1.12  kiyohara slhci_intrchange(struct slhci_softc *sc, uint8_t new_ier)
   2673   1.1     isaki {
   2674  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2675  1.12  kiyohara 	if (sc->sc_ier != new_ier) {
   2676  1.12  kiyohara 		sc->sc_ier = new_ier;
   2677  1.12  kiyohara 		slhci_write(sc, SL11_IER, new_ier);
   2678  1.12  kiyohara 		BSB_SYNC(sc->iot, sc->ioh, sc->pst, sc->psz);
   2679  1.12  kiyohara 	}
   2680   1.1     isaki }
   2681   1.1     isaki 
   2682  1.34     skrll /*
   2683  1.34     skrll  * Drain: cancel all pending transfers and put them on the callback list and
   2684  1.34     skrll  * set the UDISABLED flag.  UDISABLED is cleared only by reset.
   2685  1.34     skrll  */
   2686  1.12  kiyohara static void
   2687  1.12  kiyohara slhci_drain(struct slhci_softc *sc)
   2688   1.1     isaki {
   2689  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2690  1.12  kiyohara 	struct slhci_transfers *t;
   2691  1.12  kiyohara 	struct slhci_pipe *spipe;
   2692  1.12  kiyohara 	struct gcq *q;
   2693  1.12  kiyohara 	int i;
   2694   1.1     isaki 
   2695  1.44     skrll  	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2696   1.1     isaki 
   2697  1.12  kiyohara 	t = &sc->sc_transfers;
   2698   1.1     isaki 
   2699  1.12  kiyohara 	DLOG(D_MSG, "DRAIN flags %#x", t->flags, 0,0,0);
   2700   1.1     isaki 
   2701  1.12  kiyohara 	t->pend = INT_MAX;
   2702   1.1     isaki 
   2703  1.12  kiyohara 	for (i=0; i<=1; i++) {
   2704  1.12  kiyohara 		t->len[i] = -1;
   2705  1.12  kiyohara 		if (t->spipe[i] != NULL) {
   2706  1.12  kiyohara 			enter_callback(t, t->spipe[i]);
   2707  1.12  kiyohara 			t->spipe[i] = NULL;
   2708  1.12  kiyohara 		}
   2709   1.1     isaki 	}
   2710   1.1     isaki 
   2711  1.12  kiyohara 	/* Merge the queues into the callback queue. */
   2712  1.12  kiyohara 	gcq_merge_tail(&t->q[Q_CALLBACKS], &t->q[Q_CB]);
   2713  1.12  kiyohara 	gcq_merge_tail(&t->q[Q_CALLBACKS], &t->q[Q_NEXT_CB]);
   2714  1.12  kiyohara 	gcq_merge_tail(&t->q[Q_CALLBACKS], &t->timed);
   2715   1.1     isaki 
   2716  1.34     skrll 	/*
   2717  1.34     skrll 	 * Cancel all pipes.  Note that not all of these may be on the
   2718  1.34     skrll 	 * callback queue yet; some could be in slhci_start, for example.
   2719  1.34     skrll 	 */
   2720  1.12  kiyohara 	FOREACH_AP(q, t, spipe) {
   2721  1.27  kiyohara 		spipe->pflags |= PF_GONE;
   2722  1.48     skrll 		spipe->pipe.up_repeat = 0;
   2723  1.48     skrll 		spipe->pipe.up_aborting = 1;
   2724  1.12  kiyohara 		if (spipe->xfer != NULL)
   2725  1.48     skrll 			spipe->xfer->ux_status = USBD_CANCELLED;
   2726   1.1     isaki 	}
   2727   1.1     isaki 
   2728  1.12  kiyohara 	gcq_remove_all(&t->to);
   2729   1.1     isaki 
   2730  1.12  kiyohara 	t->flags |= F_UDISABLED;
   2731  1.12  kiyohara 	t->flags &= ~(F_AREADY|F_BREADY|F_AINPROG|F_BINPROG|F_LOWSPEED);
   2732   1.1     isaki }
   2733   1.1     isaki 
   2734  1.34     skrll /*
   2735  1.34     skrll  * RESET: SL11_CTRL_RESETENGINE=1 and SL11_CTRL_JKSTATE=0 for 50ms
   2736  1.12  kiyohara  * reconfigure SOF after reset, must wait 2.5us before USB bus activity (SOF)
   2737  1.37     skrll  * check attached device speed.
   2738  1.37     skrll  * must wait 100ms before USB transaction according to app note, 10ms
   2739  1.12  kiyohara  * by spec.  uhub does this delay
   2740  1.12  kiyohara  *
   2741  1.12  kiyohara  * Started from root hub set feature reset, which does step one.
   2742  1.48     skrll  * ub_usepolling will call slhci_reset directly, otherwise the callout goes
   2743  1.12  kiyohara  * through slhci_reset_entry.
   2744  1.12  kiyohara  */
   2745  1.12  kiyohara void
   2746  1.12  kiyohara slhci_reset(struct slhci_softc *sc)
   2747   1.1     isaki {
   2748  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2749  1.12  kiyohara 	struct slhci_transfers *t;
   2750  1.27  kiyohara 	struct slhci_pipe *spipe;
   2751  1.27  kiyohara 	struct gcq *q;
   2752  1.12  kiyohara 	uint8_t r, pol, ctrl;
   2753   1.1     isaki 
   2754  1.12  kiyohara 	t = &sc->sc_transfers;
   2755  1.41     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2756   1.1     isaki 
   2757  1.12  kiyohara 	stop_cc_time(&t_delay);
   2758   1.1     isaki 
   2759  1.12  kiyohara 	KASSERT(t->flags & F_ACTIVE);
   2760   1.1     isaki 
   2761  1.12  kiyohara 	start_cc_time(&t_delay, 0);
   2762  1.12  kiyohara 	stop_cc_time(&t_delay);
   2763   1.1     isaki 
   2764  1.12  kiyohara 	slhci_write(sc, SL11_CTRL, 0);
   2765  1.12  kiyohara 	start_cc_time(&t_delay, 3);
   2766  1.12  kiyohara 	DELAY(3);
   2767  1.12  kiyohara 	stop_cc_time(&t_delay);
   2768  1.12  kiyohara 	slhci_write(sc, SL11_ISR, 0xff);
   2769   1.1     isaki 
   2770  1.12  kiyohara 	r = slhci_read(sc, SL11_ISR);
   2771   1.1     isaki 
   2772  1.12  kiyohara 	if (r & SL11_ISR_INSERT)
   2773  1.12  kiyohara 		slhci_write(sc, SL11_ISR, SL11_ISR_INSERT);
   2774   1.1     isaki 
   2775  1.12  kiyohara 	if (r & SL11_ISR_NODEV) {
   2776  1.12  kiyohara 		DLOG(D_MSG, "NC", 0,0,0,0);
   2777  1.34     skrll 		/*
   2778  1.34     skrll 		 * Normally, the hard interrupt insert routine will issue
   2779  1.37     skrll 		 * CCONNECT, however we need to do it here if the detach
   2780  1.34     skrll 		 * happened during reset.
   2781  1.34     skrll 		 */
   2782  1.12  kiyohara 		if (!(t->flags & F_NODEV))
   2783  1.12  kiyohara 			t->flags |= F_CCONNECT|F_ROOTINTR|F_NODEV;
   2784  1.12  kiyohara 		slhci_intrchange(sc, SL11_IER_INSERT);
   2785  1.12  kiyohara 	} else {
   2786  1.12  kiyohara 		if (t->flags & F_NODEV)
   2787  1.12  kiyohara 			t->flags |= F_CCONNECT;
   2788  1.12  kiyohara 		t->flags &= ~(F_NODEV|F_LOWSPEED);
   2789  1.12  kiyohara 		if (r & SL11_ISR_DATA) {
   2790  1.12  kiyohara 			DLOG(D_MSG, "FS", 0,0,0,0);
   2791  1.12  kiyohara 			pol = ctrl = 0;
   2792  1.12  kiyohara 		} else {
   2793  1.12  kiyohara 			DLOG(D_MSG, "LS", 0,0,0,0);
   2794  1.12  kiyohara 			pol  = SL811_CSOF_POLARITY;
   2795  1.12  kiyohara 			ctrl = SL11_CTRL_LOWSPEED;
   2796  1.12  kiyohara 			t->flags |= F_LOWSPEED;
   2797  1.12  kiyohara 		}
   2798   1.1     isaki 
   2799  1.12  kiyohara 		/* Enable SOF auto-generation */
   2800  1.12  kiyohara 		t->frame = 0;	/* write to SL811_CSOF will reset frame */
   2801  1.12  kiyohara 		slhci_write(sc, SL11_SOFTIME, 0xe0);
   2802  1.12  kiyohara 		slhci_write(sc, SL811_CSOF, pol|SL811_CSOF_MASTER|0x2e);
   2803  1.12  kiyohara 		slhci_write(sc, SL11_CTRL, ctrl|SL11_CTRL_ENABLESOF);
   2804  1.12  kiyohara 
   2805  1.34     skrll 		/*
   2806  1.34     skrll 		 * According to the app note, ARM must be set
   2807  1.37     skrll 		 * for SOF generation to work.  We initialize all
   2808  1.34     skrll 		 * USBA registers here for current_tregs.
   2809  1.34     skrll 		 */
   2810  1.12  kiyohara 		slhci_write(sc, SL11_E0ADDR, SL11_BUFFER_START);
   2811  1.12  kiyohara 		slhci_write(sc, SL11_E0LEN, 0);
   2812  1.12  kiyohara 		slhci_write(sc, SL11_E0PID, SL11_PID_SOF);
   2813  1.12  kiyohara 		slhci_write(sc, SL11_E0DEV, 0);
   2814  1.12  kiyohara 		slhci_write(sc, SL11_E0CTRL, SL11_EPCTRL_ARM);
   2815  1.12  kiyohara 
   2816  1.34     skrll 		/*
   2817  1.34     skrll 		 * Initialize B registers.  This can't be done earlier since
   2818  1.37     skrll 		 * they are not valid until the SL811_CSOF register is written
   2819  1.34     skrll 		 * above due to SL11H compatability.
   2820  1.34     skrll 		 */
   2821  1.12  kiyohara 		slhci_write(sc, SL11_E1ADDR, SL11_BUFFER_END - 8);
   2822  1.12  kiyohara 		slhci_write(sc, SL11_E1LEN, 0);
   2823  1.12  kiyohara 		slhci_write(sc, SL11_E1PID, 0);
   2824  1.12  kiyohara 		slhci_write(sc, SL11_E1DEV, 0);
   2825  1.12  kiyohara 
   2826  1.12  kiyohara 		t->current_tregs[0][ADR] = SL11_BUFFER_START;
   2827  1.12  kiyohara 		t->current_tregs[0][LEN] = 0;
   2828  1.12  kiyohara 		t->current_tregs[0][PID] = SL11_PID_SOF;
   2829  1.12  kiyohara 		t->current_tregs[0][DEV] = 0;
   2830  1.12  kiyohara 		t->current_tregs[1][ADR] = SL11_BUFFER_END - 8;
   2831  1.12  kiyohara 		t->current_tregs[1][LEN] = 0;
   2832  1.12  kiyohara 		t->current_tregs[1][PID] = 0;
   2833  1.12  kiyohara 		t->current_tregs[1][DEV] = 0;
   2834  1.12  kiyohara 
   2835  1.12  kiyohara 		/* SOF start will produce USBA interrupt */
   2836  1.12  kiyohara 		t->len[A] = 0;
   2837  1.12  kiyohara 		t->flags |= F_AINPROG;
   2838  1.12  kiyohara 
   2839  1.12  kiyohara 		slhci_intrchange(sc, SLHCI_NORMAL_INTERRUPTS);
   2840  1.12  kiyohara 	}
   2841  1.12  kiyohara 
   2842  1.12  kiyohara 	t->flags &= ~(F_UDISABLED|F_RESET);
   2843  1.12  kiyohara 	t->flags |= F_CRESET|F_ROOTINTR;
   2844  1.27  kiyohara 	FOREACH_AP(q, t, spipe) {
   2845  1.27  kiyohara 		spipe->pflags &= ~PF_GONE;
   2846  1.48     skrll 		spipe->pipe.up_aborting = 0;
   2847  1.27  kiyohara 	}
   2848  1.12  kiyohara 	DLOG(D_MSG, "RESET done flags %#x", t->flags, 0,0,0);
   2849   1.1     isaki }
   2850   1.1     isaki 
   2851  1.12  kiyohara /* returns 1 if succeeded, 0 if failed, reserve == 0 is unreserve */
   2852  1.12  kiyohara static int
   2853  1.37     skrll slhci_reserve_bustime(struct slhci_softc *sc, struct slhci_pipe *spipe, int
   2854  1.12  kiyohara     reserve)
   2855   1.1     isaki {
   2856  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2857  1.12  kiyohara 	struct slhci_transfers *t;
   2858  1.12  kiyohara 	int bustime, max_packet;
   2859  1.12  kiyohara 
   2860  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2861  1.12  kiyohara 
   2862  1.12  kiyohara 	t = &sc->sc_transfers;
   2863  1.48     skrll 	max_packet = UGETW(spipe->pipe.up_endpoint->ue_edesc->wMaxPacketSize);
   2864  1.12  kiyohara 
   2865  1.12  kiyohara 	if (spipe->pflags & PF_LS)
   2866  1.12  kiyohara 		bustime = SLHCI_LS_CONST + SLHCI_LS_DATA_TIME(max_packet);
   2867  1.12  kiyohara 	else
   2868  1.12  kiyohara 		bustime = SLHCI_FS_CONST + SLHCI_FS_DATA_TIME(max_packet);
   2869   1.1     isaki 
   2870  1.12  kiyohara 	if (!reserve) {
   2871  1.12  kiyohara 		t->reserved_bustime -= bustime;
   2872  1.12  kiyohara #ifdef DIAGNOSTIC
   2873  1.12  kiyohara 		if (t->reserved_bustime < 0) {
   2874  1.37     skrll 			printf("%s: reserved_bustime %d < 0!\n",
   2875  1.12  kiyohara 			    SC_NAME(sc), t->reserved_bustime);
   2876  1.37     skrll 			DDOLOG("%s: reserved_bustime %d < 0!\n",
   2877  1.12  kiyohara 			    SC_NAME(sc), t->reserved_bustime, 0,0);
   2878  1.12  kiyohara 			t->reserved_bustime = 0;
   2879  1.12  kiyohara 		}
   2880  1.12  kiyohara #endif
   2881  1.12  kiyohara 		return 1;
   2882  1.12  kiyohara 	}
   2883   1.1     isaki 
   2884  1.12  kiyohara 	if (t->reserved_bustime + bustime > SLHCI_RESERVED_BUSTIME) {
   2885  1.37     skrll 		if (ratecheck(&sc->sc_reserved_warn_rate,
   2886  1.12  kiyohara 		    &reserved_warn_rate))
   2887  1.12  kiyohara #ifdef SLHCI_NO_OVERTIME
   2888  1.12  kiyohara 		{
   2889  1.12  kiyohara 			printf("%s: Max reserved bus time exceeded! "
   2890  1.12  kiyohara 			    "Erroring request.\n", SC_NAME(sc));
   2891  1.12  kiyohara 			DDOLOG("%s: Max reserved bus time exceeded! "
   2892  1.12  kiyohara 			    "Erroring request.\n", SC_NAME(sc), 0,0,0);
   2893  1.12  kiyohara 		}
   2894  1.12  kiyohara 		return 0;
   2895  1.12  kiyohara #else
   2896  1.12  kiyohara 		{
   2897  1.37     skrll 			printf("%s: Reserved bus time exceeds %d!\n",
   2898  1.12  kiyohara 			    SC_NAME(sc), SLHCI_RESERVED_BUSTIME);
   2899  1.37     skrll 			DDOLOG("%s: Reserved bus time exceeds %d!\n",
   2900  1.12  kiyohara 			    SC_NAME(sc), SLHCI_RESERVED_BUSTIME, 0,0);
   2901  1.12  kiyohara 		}
   2902  1.12  kiyohara #endif
   2903   1.1     isaki 	}
   2904   1.1     isaki 
   2905  1.12  kiyohara 	t->reserved_bustime += bustime;
   2906  1.12  kiyohara 	return 1;
   2907   1.1     isaki }
   2908   1.1     isaki 
   2909  1.12  kiyohara /* Device insertion/removal interrupt */
   2910   1.1     isaki static void
   2911  1.12  kiyohara slhci_insert(struct slhci_softc *sc)
   2912   1.1     isaki {
   2913  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2914  1.12  kiyohara 	struct slhci_transfers *t;
   2915  1.12  kiyohara 
   2916  1.12  kiyohara 	t = &sc->sc_transfers;
   2917   1.1     isaki 
   2918  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2919   1.1     isaki 
   2920  1.12  kiyohara 	if (t->flags & F_NODEV)
   2921  1.12  kiyohara 		slhci_intrchange(sc, 0);
   2922  1.12  kiyohara 	else {
   2923  1.12  kiyohara 		slhci_drain(sc);
   2924  1.12  kiyohara 		slhci_intrchange(sc, SL11_IER_INSERT);
   2925   1.1     isaki 	}
   2926  1.12  kiyohara 	t->flags ^= F_NODEV;
   2927  1.12  kiyohara 	t->flags |= F_ROOTINTR|F_CCONNECT;
   2928  1.12  kiyohara 	DLOG(D_MSG, "INSERT intr: flags after %#x", t->flags, 0,0,0);
   2929   1.1     isaki }
   2930   1.1     isaki 
   2931  1.12  kiyohara /*
   2932  1.12  kiyohara  * Data structures and routines to emulate the root hub.
   2933  1.12  kiyohara  */
   2934  1.12  kiyohara 
   2935   1.1     isaki static usbd_status
   2936  1.12  kiyohara slhci_clear_feature(struct slhci_softc *sc, unsigned int what)
   2937   1.1     isaki {
   2938  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2939  1.12  kiyohara 	struct slhci_transfers *t;
   2940  1.12  kiyohara 	usbd_status error;
   2941   1.1     isaki 
   2942  1.12  kiyohara 	t = &sc->sc_transfers;
   2943  1.12  kiyohara 	error = USBD_NORMAL_COMPLETION;
   2944   1.1     isaki 
   2945  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2946   1.1     isaki 
   2947  1.12  kiyohara 	if (what == UHF_PORT_POWER) {
   2948  1.12  kiyohara 		DLOG(D_MSG, "POWER_OFF", 0,0,0,0);
   2949  1.12  kiyohara 		t->flags &= ~F_POWER;
   2950  1.12  kiyohara 		if (!(t->flags & F_NODEV))
   2951  1.12  kiyohara 			t->flags |= F_NODEV|F_CCONNECT|F_ROOTINTR;
   2952  1.12  kiyohara 		/* for x68k Nereid USB controller */
   2953  1.12  kiyohara 		if (sc->sc_enable_power && (t->flags & F_REALPOWER)) {
   2954  1.12  kiyohara 			t->flags &= ~F_REALPOWER;
   2955  1.12  kiyohara 			sc->sc_enable_power(sc, POWER_OFF);
   2956  1.12  kiyohara 		}
   2957  1.12  kiyohara 		slhci_intrchange(sc, 0);
   2958  1.37     skrll 		slhci_drain(sc);
   2959  1.12  kiyohara 	} else if (what == UHF_C_PORT_CONNECTION) {
   2960  1.12  kiyohara 		t->flags &= ~F_CCONNECT;
   2961  1.12  kiyohara 	} else if (what == UHF_C_PORT_RESET) {
   2962  1.12  kiyohara 		t->flags &= ~F_CRESET;
   2963  1.12  kiyohara 	} else if (what == UHF_PORT_ENABLE) {
   2964  1.12  kiyohara 		slhci_drain(sc);
   2965  1.12  kiyohara 	} else if (what != UHF_PORT_SUSPEND) {
   2966  1.12  kiyohara 		DDOLOG("ClrPortFeatERR:value=%#.4x", what, 0,0,0);
   2967  1.12  kiyohara 		error = USBD_IOERROR;
   2968  1.12  kiyohara 	}
   2969   1.1     isaki 
   2970  1.12  kiyohara 	return error;
   2971   1.1     isaki }
   2972   1.1     isaki 
   2973   1.1     isaki static usbd_status
   2974  1.12  kiyohara slhci_set_feature(struct slhci_softc *sc, unsigned int what)
   2975   1.1     isaki {
   2976  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   2977  1.12  kiyohara 	struct slhci_transfers *t;
   2978  1.12  kiyohara 	uint8_t r;
   2979  1.12  kiyohara 
   2980  1.12  kiyohara 	t = &sc->sc_transfers;
   2981  1.12  kiyohara 
   2982  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   2983  1.12  kiyohara 
   2984  1.12  kiyohara 	if (what == UHF_PORT_RESET) {
   2985  1.12  kiyohara 		if (!(t->flags & F_ACTIVE)) {
   2986  1.37     skrll 			DDOLOG("SET PORT_RESET when not ACTIVE!",
   2987  1.12  kiyohara 			    0,0,0,0);
   2988  1.12  kiyohara 			return USBD_INVAL;
   2989  1.12  kiyohara 		}
   2990  1.12  kiyohara 		if (!(t->flags & F_POWER)) {
   2991  1.12  kiyohara 			DDOLOG("SET PORT_RESET without PORT_POWER! flags %p",
   2992  1.12  kiyohara 			    t->flags, 0,0,0);
   2993  1.12  kiyohara 			return USBD_INVAL;
   2994  1.12  kiyohara 		}
   2995  1.12  kiyohara 		if (t->flags & F_RESET)
   2996  1.12  kiyohara 			return USBD_NORMAL_COMPLETION;
   2997  1.12  kiyohara 		DLOG(D_MSG, "RESET flags %#x", t->flags, 0,0,0);
   2998  1.12  kiyohara 		slhci_intrchange(sc, 0);
   2999  1.37     skrll 		slhci_drain(sc);
   3000  1.12  kiyohara 		slhci_write(sc, SL11_CTRL, SL11_CTRL_RESETENGINE);
   3001  1.12  kiyohara 		/* usb spec says delay >= 10ms, app note 50ms */
   3002  1.12  kiyohara  		start_cc_time(&t_delay, 50000);
   3003  1.48     skrll 		if (sc->sc_bus.ub_usepolling) {
   3004  1.12  kiyohara 			DELAY(50000);
   3005  1.12  kiyohara 			slhci_reset(sc);
   3006  1.12  kiyohara 		} else {
   3007  1.12  kiyohara 			t->flags |= F_RESET;
   3008  1.12  kiyohara 			callout_schedule(&sc->sc_timer, max(mstohz(50), 2));
   3009  1.12  kiyohara 		}
   3010  1.12  kiyohara 	} else if (what == UHF_PORT_SUSPEND) {
   3011  1.12  kiyohara 		printf("%s: USB Suspend not implemented!\n", SC_NAME(sc));
   3012  1.37     skrll 		DDOLOG("%s: USB Suspend not implemented!\n", SC_NAME(sc),
   3013  1.12  kiyohara 		    0,0,0);
   3014  1.12  kiyohara 	} else if (what == UHF_PORT_POWER) {
   3015  1.12  kiyohara 		DLOG(D_MSG, "PORT_POWER", 0,0,0,0);
   3016  1.12  kiyohara 		/* for x68k Nereid USB controller */
   3017  1.12  kiyohara 		if (!(t->flags & F_ACTIVE))
   3018  1.12  kiyohara 			return USBD_INVAL;
   3019  1.12  kiyohara 		if (t->flags & F_POWER)
   3020  1.12  kiyohara 			return USBD_NORMAL_COMPLETION;
   3021  1.12  kiyohara 		if (!(t->flags & F_REALPOWER)) {
   3022  1.12  kiyohara 			if (sc->sc_enable_power)
   3023  1.12  kiyohara 				sc->sc_enable_power(sc, POWER_ON);
   3024  1.12  kiyohara 			t->flags |= F_REALPOWER;
   3025  1.12  kiyohara 		}
   3026  1.12  kiyohara 		t->flags |= F_POWER;
   3027  1.12  kiyohara 		r = slhci_read(sc, SL11_ISR);
   3028  1.12  kiyohara 		if (r & SL11_ISR_INSERT)
   3029  1.12  kiyohara 			slhci_write(sc, SL11_ISR, SL11_ISR_INSERT);
   3030  1.12  kiyohara 		if (r & SL11_ISR_NODEV) {
   3031  1.12  kiyohara 			slhci_intrchange(sc, SL11_IER_INSERT);
   3032  1.12  kiyohara 			t->flags |= F_NODEV;
   3033  1.12  kiyohara 		} else {
   3034  1.12  kiyohara 			t->flags &= ~F_NODEV;
   3035  1.12  kiyohara 			t->flags |= F_CCONNECT|F_ROOTINTR;
   3036  1.12  kiyohara 		}
   3037  1.12  kiyohara 	} else {
   3038  1.12  kiyohara 		DDOLOG("SetPortFeatERR=%#.8x", what, 0,0,0);
   3039  1.12  kiyohara 		return USBD_IOERROR;
   3040  1.12  kiyohara 	}
   3041   1.1     isaki 
   3042   1.1     isaki 	return USBD_NORMAL_COMPLETION;
   3043   1.1     isaki }
   3044   1.1     isaki 
   3045   1.1     isaki static void
   3046  1.12  kiyohara slhci_get_status(struct slhci_softc *sc, usb_port_status_t *ps)
   3047   1.1     isaki {
   3048  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3049  1.12  kiyohara 	struct slhci_transfers *t;
   3050  1.12  kiyohara 	unsigned int status, change;
   3051  1.12  kiyohara 
   3052  1.12  kiyohara 	t = &sc->sc_transfers;
   3053  1.12  kiyohara 
   3054  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   3055   1.1     isaki 
   3056  1.34     skrll 	/*
   3057  1.34     skrll 	 * We do not have a way to detect over current or bable and
   3058  1.37     skrll 	 * suspend is currently not implemented, so connect and reset
   3059  1.34     skrll 	 * are the only changes that need to be reported.
   3060  1.34     skrll 	 */
   3061  1.12  kiyohara 	change = 0;
   3062  1.12  kiyohara 	if (t->flags & F_CCONNECT)
   3063  1.12  kiyohara 		change |= UPS_C_CONNECT_STATUS;
   3064  1.12  kiyohara 	if (t->flags & F_CRESET)
   3065  1.12  kiyohara 		change |= UPS_C_PORT_RESET;
   3066  1.12  kiyohara 
   3067  1.12  kiyohara 	status = 0;
   3068  1.12  kiyohara 	if (!(t->flags & F_NODEV))
   3069  1.12  kiyohara 		status |= UPS_CURRENT_CONNECT_STATUS;
   3070  1.12  kiyohara 	if (!(t->flags & F_UDISABLED))
   3071  1.12  kiyohara 		status |= UPS_PORT_ENABLED;
   3072  1.12  kiyohara 	if (t->flags & F_RESET)
   3073  1.12  kiyohara 		status |= UPS_RESET;
   3074  1.12  kiyohara 	if (t->flags & F_POWER)
   3075  1.12  kiyohara 		status |= UPS_PORT_POWER;
   3076  1.12  kiyohara 	if (t->flags & F_LOWSPEED)
   3077  1.12  kiyohara 		status |= UPS_LOW_SPEED;
   3078  1.37     skrll 	USETW(ps->wPortStatus, status);
   3079  1.12  kiyohara 	USETW(ps->wPortChange, change);
   3080  1.12  kiyohara 	DLOG(D_ROOT, "status=%#.4x, change=%#.4x", status, change, 0,0);
   3081   1.1     isaki }
   3082   1.1     isaki 
   3083  1.12  kiyohara static usbd_status
   3084  1.48     skrll slhci_root(struct slhci_softc *sc, struct slhci_pipe *spipe,
   3085  1.48     skrll     struct usbd_xfer *xfer)
   3086   1.1     isaki {
   3087  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3088  1.12  kiyohara 	struct slhci_transfers *t;
   3089   1.1     isaki 
   3090  1.12  kiyohara 	t = &sc->sc_transfers;
   3091   1.1     isaki 
   3092  1.37     skrll 	LK_SLASSERT(spipe != NULL && xfer != NULL, sc, spipe, xfer, return
   3093  1.12  kiyohara 	    USBD_CANCELLED);
   3094   1.1     isaki 
   3095  1.12  kiyohara 	DLOG(D_TRACE, "%s start", pnames(SLHCI_XFER_TYPE(xfer)), 0,0,0);
   3096  1.44     skrll 	KASSERT(mutex_owned(&sc->sc_intr_lock));
   3097   1.1     isaki 
   3098  1.48     skrll 	KASSERT(spipe->ptype == PT_ROOT_INTR);
   3099  1.70     skrll #if 0
   3100  1.48     skrll 	LK_SLASSERT(t->rootintr == NULL, sc, spipe, xfer, return
   3101  1.48     skrll 	    USBD_CANCELLED);
   3102  1.70     skrll #endif
   3103  1.48     skrll 	t->rootintr = xfer;
   3104  1.48     skrll 	if (t->flags & F_CHANGE)
   3105  1.48     skrll 		t->flags |= F_ROOTINTR;
   3106  1.48     skrll 	return USBD_IN_PROGRESS;
   3107  1.48     skrll }
   3108   1.1     isaki 
   3109  1.48     skrll static int
   3110  1.48     skrll slhci_roothub_ctrl(struct usbd_bus *bus, usb_device_request_t *req,
   3111  1.48     skrll     void *buf, int buflen)
   3112  1.48     skrll {
   3113  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3114  1.48     skrll 	struct slhci_softc *sc = SLHCI_BUS2SC(bus);
   3115  1.48     skrll 	struct slhci_transfers *t = &sc->sc_transfers;
   3116  1.48     skrll 	usbd_status error = USBD_IOERROR; /* XXX should be STALL */
   3117  1.48     skrll 	uint16_t len, value, index;
   3118  1.48     skrll 	uint8_t type;
   3119  1.48     skrll 	int actlen = 0;
   3120  1.12  kiyohara 
   3121  1.12  kiyohara 	len = UGETW(req->wLength);
   3122  1.12  kiyohara 	value = UGETW(req->wValue);
   3123  1.12  kiyohara 	index = UGETW(req->wIndex);
   3124   1.1     isaki 
   3125  1.37     skrll 	type = req->bmRequestType;
   3126   1.1     isaki 
   3127  1.12  kiyohara 	SLHCI_DEXEC(D_TRACE, slhci_log_req_hub(req));
   3128   1.1     isaki 
   3129  1.12  kiyohara 	/*
   3130  1.12  kiyohara 	 * USB requests for hubs have two basic types, standard and class.
   3131  1.37     skrll 	 * Each could potentially have recipients of device, interface,
   3132  1.12  kiyohara 	 * endpoint, or other.  For the hub class, CLASS_OTHER means the port
   3133  1.12  kiyohara 	 * and CLASS_DEVICE means the hub.  For standard requests, OTHER
   3134  1.37     skrll 	 * is not used.  Standard request are described in section 9.4 of the
   3135  1.37     skrll 	 * standard, hub class requests in 11.16.  Each request is either read
   3136  1.12  kiyohara 	 * or write.
   3137  1.12  kiyohara 	 *
   3138  1.37     skrll 	 * Clear Feature, Set Feature, and Status are defined for each of the
   3139  1.37     skrll 	 * used recipients.  Get Descriptor and Set Descriptor are defined for
   3140  1.37     skrll 	 * both standard and hub class types with different descriptors.
   3141  1.37     skrll 	 * Other requests have only one defined recipient and type.  These
   3142  1.37     skrll 	 * include: Get/Set Address, Get/Set Configuration, Get/Set Interface,
   3143  1.37     skrll 	 * and Synch Frame for standard requests and Get Bus State for hub
   3144  1.12  kiyohara 	 * class.
   3145  1.12  kiyohara 	 *
   3146  1.37     skrll 	 * When a device is first powered up it has address 0 until the
   3147  1.12  kiyohara 	 * address is set.
   3148  1.37     skrll 	 *
   3149  1.37     skrll 	 * Hubs are only allowed to support one interface and may not have
   3150  1.37     skrll 	 * isochronous endpoints.  The results of the related requests are
   3151  1.12  kiyohara 	 * undefined.
   3152  1.12  kiyohara 	 *
   3153  1.37     skrll 	 * The standard requires invalid or unsupported requests to return
   3154  1.37     skrll 	 * STALL in the data stage, however this does not work well with
   3155  1.12  kiyohara 	 * current error handling. XXX
   3156  1.12  kiyohara 	 *
   3157  1.12  kiyohara 	 * Some unsupported fields:
   3158  1.12  kiyohara 	 * Clear Hub Feature is for C_HUB_LOCAL_POWER and C_HUB_OVER_CURRENT
   3159  1.12  kiyohara 	 * Set Device Features is for ENDPOINT_HALT and DEVICE_REMOTE_WAKEUP
   3160  1.12  kiyohara 	 * Get Bus State is optional sample of D- and D+ at EOF2
   3161  1.12  kiyohara 	 */
   3162   1.1     isaki 
   3163  1.12  kiyohara 	switch (req->bRequest) {
   3164  1.12  kiyohara 	/* Write Requests */
   3165  1.12  kiyohara 	case UR_CLEAR_FEATURE:
   3166  1.12  kiyohara 		if (type == UT_WRITE_CLASS_OTHER) {
   3167  1.69     skrll 			if (index == 1 /* Port */) {
   3168  1.69     skrll 				mutex_enter(&sc->sc_intr_lock);
   3169  1.12  kiyohara 				error = slhci_clear_feature(sc, value);
   3170  1.69     skrll 				mutex_exit(&sc->sc_intr_lock);
   3171  1.69     skrll 			} else
   3172  1.12  kiyohara 				DLOG(D_ROOT, "Clear Port Feature "
   3173  1.12  kiyohara 				    "index = %#.4x", index, 0,0,0);
   3174  1.12  kiyohara 		}
   3175  1.12  kiyohara 		break;
   3176  1.12  kiyohara 	case UR_SET_FEATURE:
   3177  1.12  kiyohara 		if (type == UT_WRITE_CLASS_OTHER) {
   3178  1.68     skrll 			if (index == 1 /* Port */) {
   3179  1.68     skrll 				mutex_enter(&sc->sc_intr_lock);
   3180  1.12  kiyohara 				error = slhci_set_feature(sc, value);
   3181  1.68     skrll 				mutex_exit(&sc->sc_intr_lock);
   3182  1.68     skrll 			} else
   3183  1.12  kiyohara 				DLOG(D_ROOT, "Set Port Feature "
   3184  1.12  kiyohara 				    "index = %#.4x", index, 0,0,0);
   3185  1.12  kiyohara 		} else if (type != UT_WRITE_CLASS_DEVICE)
   3186  1.12  kiyohara 			DLOG(D_ROOT, "Set Device Feature "
   3187  1.12  kiyohara 			    "ENDPOINT_HALT or DEVICE_REMOTE_WAKEUP "
   3188  1.12  kiyohara 			    "not supported", 0,0,0,0);
   3189  1.12  kiyohara 		break;
   3190  1.48     skrll 
   3191  1.12  kiyohara 	/* Read Requests */
   3192  1.12  kiyohara 	case UR_GET_STATUS:
   3193  1.12  kiyohara 		if (type == UT_READ_CLASS_OTHER) {
   3194  1.12  kiyohara 			if (index == 1 /* Port */ && len == /* XXX >=? */
   3195  1.12  kiyohara 			    sizeof(usb_port_status_t)) {
   3196  1.68     skrll 				mutex_enter(&sc->sc_intr_lock);
   3197  1.12  kiyohara 				slhci_get_status(sc, (usb_port_status_t *)
   3198  1.12  kiyohara 				    buf);
   3199  1.68     skrll 				mutex_exit(&sc->sc_intr_lock);
   3200  1.12  kiyohara 				actlen = sizeof(usb_port_status_t);
   3201  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3202  1.37     skrll 			} else
   3203  1.37     skrll 				DLOG(D_ROOT, "Get Port Status index = %#.4x "
   3204  1.12  kiyohara 				    "len = %#.4x", index, len, 0,0);
   3205  1.12  kiyohara 		} else if (type == UT_READ_CLASS_DEVICE) { /* XXX index? */
   3206  1.12  kiyohara 			if (len == sizeof(usb_hub_status_t)) {
   3207  1.37     skrll 				DLOG(D_ROOT, "Get Hub Status",
   3208  1.12  kiyohara 				    0,0,0,0);
   3209  1.12  kiyohara 				actlen = sizeof(usb_hub_status_t);
   3210  1.12  kiyohara 				memset(buf, 0, actlen);
   3211  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3212  1.12  kiyohara 			} else
   3213  1.12  kiyohara 				DLOG(D_ROOT, "Get Hub Status bad len %#.4x",
   3214  1.12  kiyohara 				    len, 0,0,0);
   3215  1.12  kiyohara 		}
   3216  1.12  kiyohara 		break;
   3217  1.12  kiyohara 	case UR_GET_DESCRIPTOR:
   3218  1.12  kiyohara 		if (type == UT_READ_DEVICE) {
   3219  1.12  kiyohara 			/* value is type (&0xff00) and index (0xff) */
   3220  1.12  kiyohara 			if (value == (UDESC_DEVICE<<8)) {
   3221  1.48     skrll 				usb_device_descriptor_t devd;
   3222  1.48     skrll 
   3223  1.48     skrll 				actlen = min(buflen, sizeof(devd));
   3224  1.48     skrll 				memcpy(&devd, buf, actlen);
   3225  1.48     skrll 				USETW(devd.idVendor, USB_VENDOR_SCANLOGIC);
   3226  1.48     skrll 				memcpy(buf, &devd, actlen);
   3227  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3228  1.12  kiyohara 			} else if (value == (UDESC_CONFIG<<8)) {
   3229  1.48     skrll 				struct usb_roothub_descriptors confd;
   3230  1.48     skrll 
   3231  1.48     skrll 				actlen = min(buflen, sizeof(confd));
   3232  1.48     skrll 				memcpy(&confd, buf, actlen);
   3233  1.48     skrll 
   3234  1.48     skrll 				/* 2 mA units */
   3235  1.48     skrll 				confd.urh_confd.bMaxPower = t->max_current;
   3236  1.48     skrll 				memcpy(buf, &confd, actlen);
   3237  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3238  1.12  kiyohara 			} else if (value == ((UDESC_STRING<<8)|1)) {
   3239  1.12  kiyohara 				/* Vendor */
   3240  1.20     isaki 				actlen = usb_makestrdesc((usb_string_descriptor_t *)
   3241  1.12  kiyohara 				    buf, len, "ScanLogic/Cypress");
   3242  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3243  1.12  kiyohara 			} else if (value == ((UDESC_STRING<<8)|2)) {
   3244  1.12  kiyohara 				/* Product */
   3245  1.20     isaki 				actlen = usb_makestrdesc((usb_string_descriptor_t *)
   3246  1.12  kiyohara 				    buf, len, "SL811HS/T root hub");
   3247  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3248  1.12  kiyohara 			} else
   3249  1.12  kiyohara 				DDOLOG("Unknown Get Descriptor %#.4x",
   3250  1.12  kiyohara 				    value, 0,0,0);
   3251  1.12  kiyohara 		} else if (type == UT_READ_CLASS_DEVICE) {
   3252  1.12  kiyohara 			/* Descriptor number is 0 */
   3253  1.12  kiyohara 			if (value == (UDESC_HUB<<8)) {
   3254  1.48     skrll 				usb_hub_descriptor_t hubd;
   3255  1.48     skrll 
   3256  1.48     skrll 				actlen = min(buflen, sizeof(hubd));
   3257  1.48     skrll 				memcpy(&hubd, buf, actlen);
   3258  1.48     skrll 				hubd.bHubContrCurrent =
   3259  1.48     skrll 				    500 - t->max_current;
   3260  1.48     skrll 				memcpy(buf, &hubd, actlen);
   3261  1.12  kiyohara 				error = USBD_NORMAL_COMPLETION;
   3262  1.12  kiyohara 			} else
   3263  1.12  kiyohara 				DDOLOG("Unknown Get Hub Descriptor %#.4x",
   3264  1.12  kiyohara 				    value, 0,0,0);
   3265  1.12  kiyohara 		}
   3266  1.12  kiyohara 		break;
   3267  1.48     skrll 	default:
   3268  1.48     skrll 		/* default from usbroothub */
   3269  1.48     skrll 		return buflen;
   3270   1.1     isaki 	}
   3271   1.1     isaki 
   3272  1.12  kiyohara 	if (error == USBD_NORMAL_COMPLETION)
   3273  1.48     skrll 		return actlen;
   3274  1.12  kiyohara 
   3275  1.48     skrll 	return -1;
   3276   1.1     isaki }
   3277   1.1     isaki 
   3278  1.12  kiyohara /* End in lock functions. Start debug functions. */
   3279  1.12  kiyohara 
   3280  1.12  kiyohara #ifdef SLHCI_DEBUG
   3281   1.1     isaki void
   3282  1.12  kiyohara slhci_log_buffer(struct usbd_xfer *xfer)
   3283   1.1     isaki {
   3284  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3285  1.12  kiyohara 	u_char *buf;
   3286   1.1     isaki 
   3287  1.48     skrll 	if(xfer->ux_length > 0 &&
   3288  1.48     skrll 	    UE_GET_DIR(xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress) ==
   3289  1.12  kiyohara 	    UE_DIR_IN) {
   3290  1.48     skrll 		buf = xfer->ux_buf;
   3291  1.48     skrll 		DDOLOGBUF(buf, xfer->ux_actlen);
   3292  1.48     skrll 		DDOLOG("len %d actlen %d short %d", xfer->ux_length,
   3293  1.48     skrll 		    xfer->ux_actlen, xfer->ux_length - xfer->ux_actlen, 0);
   3294  1.12  kiyohara 	}
   3295   1.1     isaki }
   3296   1.1     isaki 
   3297   1.1     isaki void
   3298  1.12  kiyohara slhci_log_req(usb_device_request_t *r)
   3299   1.1     isaki {
   3300  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3301  1.12  kiyohara 	static const char *xmes[]={
   3302   1.1     isaki 		"GETSTAT",
   3303   1.1     isaki 		"CLRFEAT",
   3304   1.1     isaki 		"res",
   3305   1.1     isaki 		"SETFEAT",
   3306   1.1     isaki 		"res",
   3307   1.1     isaki 		"SETADDR",
   3308   1.1     isaki 		"GETDESC",
   3309   1.1     isaki 		"SETDESC",
   3310   1.1     isaki 		"GETCONF",
   3311   1.1     isaki 		"SETCONF",
   3312   1.1     isaki 		"GETIN/F",
   3313   1.1     isaki 		"SETIN/F",
   3314  1.12  kiyohara 		"SYNC_FR",
   3315  1.12  kiyohara 		"UNKNOWN"
   3316   1.1     isaki 	};
   3317  1.12  kiyohara 	int req, mreq, type, value, index, len;
   3318   1.1     isaki 
   3319   1.1     isaki 	req   = r->bRequest;
   3320  1.12  kiyohara 	mreq  = (req > 13) ? 13 : req;
   3321   1.1     isaki 	type  = r->bmRequestType;
   3322   1.1     isaki 	value = UGETW(r->wValue);
   3323   1.1     isaki 	index = UGETW(r->wIndex);
   3324   1.1     isaki 	len   = UGETW(r->wLength);
   3325   1.1     isaki 
   3326  1.12  kiyohara 	DDOLOG("request: %s %#x", xmes[mreq], type, 0,0);
   3327  1.12  kiyohara 	DDOLOG("request: r=%d,v=%d,i=%d,l=%d ", req, value, index, len);
   3328   1.1     isaki }
   3329   1.1     isaki 
   3330   1.1     isaki void
   3331  1.12  kiyohara slhci_log_req_hub(usb_device_request_t *r)
   3332   1.1     isaki {
   3333  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3334  1.12  kiyohara 	static const struct {
   3335   1.1     isaki 		int req;
   3336   1.1     isaki 		int type;
   3337   1.9  christos 		const char *str;
   3338   1.1     isaki 	} conf[] = {
   3339   1.1     isaki 		{ 1, 0x20, "ClrHubFeat"  },
   3340   1.1     isaki 		{ 1, 0x23, "ClrPortFeat" },
   3341   1.1     isaki 		{ 2, 0xa3, "GetBusState" },
   3342   1.1     isaki 		{ 6, 0xa0, "GetHubDesc"  },
   3343   1.1     isaki 		{ 0, 0xa0, "GetHubStat"  },
   3344   1.1     isaki 		{ 0, 0xa3, "GetPortStat" },
   3345   1.1     isaki 		{ 7, 0x20, "SetHubDesc"  },
   3346   1.1     isaki 		{ 3, 0x20, "SetHubFeat"  },
   3347   1.1     isaki 		{ 3, 0x23, "SetPortFeat" },
   3348   1.1     isaki 		{-1, 0, NULL},
   3349   1.1     isaki 	};
   3350   1.1     isaki 	int i;
   3351   1.1     isaki 	int value, index, len;
   3352  1.12  kiyohara 	const char *str;
   3353   1.1     isaki 
   3354   1.1     isaki 	value = UGETW(r->wValue);
   3355   1.1     isaki 	index = UGETW(r->wIndex);
   3356   1.1     isaki 	len   = UGETW(r->wLength);
   3357   1.1     isaki 	for (i = 0; ; i++) {
   3358  1.12  kiyohara 		if (conf[i].req == -1 ) {
   3359  1.12  kiyohara 			slhci_log_req(r);
   3360  1.12  kiyohara 			return;
   3361  1.12  kiyohara 		}
   3362   1.1     isaki 		if (r->bmRequestType == conf[i].type && r->bRequest == conf[i].req) {
   3363  1.12  kiyohara 			str = conf[i].str;
   3364   1.1     isaki 			break;
   3365   1.1     isaki 		}
   3366   1.1     isaki 	}
   3367  1.12  kiyohara 	DDOLOG("hub request: %s v=%d,i=%d,l=%d ", str, value, index, len);
   3368   1.1     isaki }
   3369   1.1     isaki 
   3370   1.1     isaki void
   3371  1.12  kiyohara slhci_log_dumpreg(void)
   3372   1.1     isaki {
   3373  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3374  1.12  kiyohara 	uint8_t r;
   3375  1.12  kiyohara 	unsigned int aaddr, alen, baddr, blen;
   3376  1.12  kiyohara 	static u_char buf[240];
   3377  1.12  kiyohara 
   3378  1.12  kiyohara 	r = slhci_read(ssc, SL11_E0CTRL);
   3379  1.12  kiyohara 	DDOLOG("USB A Host Control = %#.2x", r, 0,0,0);
   3380  1.37     skrll 	DDOLOGFLAG8("E0CTRL=", r, "Preamble", "Data Toggle",  "SOF Sync",
   3381  1.12  kiyohara 	    "ISOC", "res", "Out", "Enable", "Arm");
   3382  1.12  kiyohara 	aaddr = slhci_read(ssc, SL11_E0ADDR);
   3383  1.12  kiyohara 	DDOLOG("USB A Base Address = %u", aaddr, 0,0,0);
   3384  1.12  kiyohara 	alen = slhci_read(ssc, SL11_E0LEN);
   3385  1.12  kiyohara 	DDOLOG("USB A Length = %u", alen, 0,0,0);
   3386  1.12  kiyohara 	r = slhci_read(ssc, SL11_E0STAT);
   3387  1.12  kiyohara 	DDOLOG("USB A Status = %#.2x", r, 0,0,0);
   3388  1.12  kiyohara 	DDOLOGFLAG8("E0STAT=", r, "STALL", "NAK", "Overflow", "Setup",
   3389  1.12  kiyohara 	    "Data Toggle", "Timeout", "Error", "ACK");
   3390  1.12  kiyohara 	r = slhci_read(ssc, SL11_E0CONT);
   3391  1.12  kiyohara 	DDOLOG("USB A Remaining or Overflow Length = %u", r, 0,0,0);
   3392  1.12  kiyohara 	r = slhci_read(ssc, SL11_E1CTRL);
   3393  1.12  kiyohara 	DDOLOG("USB B Host Control = %#.2x", r, 0,0,0);
   3394  1.37     skrll 	DDOLOGFLAG8("E1CTRL=", r, "Preamble", "Data Toggle",  "SOF Sync",
   3395  1.12  kiyohara 	    "ISOC", "res", "Out", "Enable", "Arm");
   3396  1.12  kiyohara 	baddr = slhci_read(ssc, SL11_E1ADDR);
   3397  1.12  kiyohara 	DDOLOG("USB B Base Address = %u", baddr, 0,0,0);
   3398  1.12  kiyohara 	blen = slhci_read(ssc, SL11_E1LEN);
   3399  1.12  kiyohara 	DDOLOG("USB B Length = %u", blen, 0,0,0);
   3400  1.12  kiyohara 	r = slhci_read(ssc, SL11_E1STAT);
   3401  1.12  kiyohara 	DDOLOG("USB B Status = %#.2x", r, 0,0,0);
   3402  1.12  kiyohara 	DDOLOGFLAG8("E1STAT=", r, "STALL", "NAK", "Overflow", "Setup",
   3403  1.12  kiyohara 	    "Data Toggle", "Timeout", "Error", "ACK");
   3404  1.12  kiyohara 	r = slhci_read(ssc, SL11_E1CONT);
   3405  1.12  kiyohara 	DDOLOG("USB B Remaining or Overflow Length = %u", r, 0,0,0);
   3406  1.12  kiyohara 
   3407  1.12  kiyohara 	r = slhci_read(ssc, SL11_CTRL);
   3408  1.12  kiyohara 	DDOLOG("Control = %#.2x", r, 0,0,0);
   3409  1.37     skrll 	DDOLOGFLAG8("CTRL=", r, "res", "Suspend", "LOW Speed",
   3410  1.12  kiyohara 	    "J-K State Force", "Reset", "res", "res", "SOF");
   3411  1.12  kiyohara 	r = slhci_read(ssc, SL11_IER);
   3412  1.12  kiyohara 	DDOLOG("Interrupt Enable = %#.2x", r, 0,0,0);
   3413  1.12  kiyohara 	DDOLOGFLAG8("IER=", r, "D+ **IER!**", "Device Detect/Resume",
   3414  1.12  kiyohara 	    "Insert/Remove", "SOF", "res", "res", "USBB", "USBA");
   3415  1.12  kiyohara 	r = slhci_read(ssc, SL11_ISR);
   3416  1.12  kiyohara 	DDOLOG("Interrupt Status = %#.2x", r, 0,0,0);
   3417  1.12  kiyohara 	DDOLOGFLAG8("ISR=", r, "D+", "Device Detect/Resume",
   3418  1.12  kiyohara 	    "Insert/Remove", "SOF", "res", "res", "USBB", "USBA");
   3419  1.12  kiyohara 	r = slhci_read(ssc, SL11_REV);
   3420  1.12  kiyohara 	DDOLOG("Revision = %#.2x", r, 0,0,0);
   3421  1.12  kiyohara 	r = slhci_read(ssc, SL811_CSOF);
   3422  1.12  kiyohara 	DDOLOG("SOF Counter = %#.2x", r, 0,0,0);
   3423  1.12  kiyohara 
   3424  1.37     skrll 	if (alen && aaddr >= SL11_BUFFER_START && aaddr < SL11_BUFFER_END &&
   3425  1.12  kiyohara 	    alen <= SL11_MAX_PACKET_SIZE && aaddr + alen <= SL11_BUFFER_END) {
   3426  1.12  kiyohara 		slhci_read_multi(ssc, aaddr, buf, alen);
   3427  1.12  kiyohara 		DDOLOG("USBA Buffer: start %u len %u", aaddr, alen, 0,0);
   3428  1.12  kiyohara 		DDOLOGBUF(buf, alen);
   3429  1.12  kiyohara 	} else if (alen)
   3430  1.12  kiyohara 		DDOLOG("USBA Buffer Invalid", 0,0,0,0);
   3431  1.12  kiyohara 
   3432  1.37     skrll 	if (blen && baddr >= SL11_BUFFER_START && baddr < SL11_BUFFER_END &&
   3433  1.12  kiyohara 	    blen <= SL11_MAX_PACKET_SIZE && baddr + blen <= SL11_BUFFER_END) {
   3434  1.12  kiyohara 		slhci_read_multi(ssc, baddr, buf, blen);
   3435  1.12  kiyohara 		DDOLOG("USBB Buffer: start %u len %u", baddr, blen, 0,0);
   3436  1.12  kiyohara 		DDOLOGBUF(buf, blen);
   3437  1.12  kiyohara 	} else if (blen)
   3438  1.12  kiyohara 		DDOLOG("USBB Buffer Invalid", 0,0,0,0);
   3439   1.1     isaki }
   3440   1.1     isaki 
   3441   1.1     isaki void
   3442  1.12  kiyohara slhci_log_xfer(struct usbd_xfer *xfer)
   3443   1.1     isaki {
   3444  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3445  1.12  kiyohara 	DDOLOG("xfer: length=%u, actlen=%u, flags=%#x, timeout=%u,",
   3446  1.48     skrll 		xfer->ux_length, xfer->ux_actlen, xfer->ux_flags, xfer->ux_timeout);
   3447  1.56     skrll 	DDOLOG("buffer=%p", xfer->ux_buf, 0,0,0);
   3448  1.48     skrll 	slhci_log_req_hub(&xfer->ux_request);
   3449  1.12  kiyohara }
   3450  1.12  kiyohara 
   3451  1.12  kiyohara void
   3452  1.12  kiyohara slhci_log_spipe(struct slhci_pipe *spipe)
   3453  1.12  kiyohara {
   3454  1.56     skrll 	SLHCIHIST_FUNC(); SLHCIHIST_CALLED();
   3455  1.37     skrll 	DDOLOG("spipe %p onlists: %s %s %s", spipe, gcq_onlist(&spipe->ap) ?
   3456  1.37     skrll 	    "AP" : "", gcq_onlist(&spipe->to) ? "TO" : "",
   3457  1.12  kiyohara 	    gcq_onlist(&spipe->xq) ? "XQ" : "");
   3458  1.12  kiyohara 	DDOLOG("spipe: xfer %p buffer %p pflags %#x ptype %s",
   3459  1.12  kiyohara 	    spipe->xfer, spipe->buffer, spipe->pflags, pnames(spipe->ptype));
   3460  1.12  kiyohara }
   3461  1.12  kiyohara 
   3462  1.12  kiyohara void
   3463  1.12  kiyohara slhci_print_intr(void)
   3464  1.12  kiyohara {
   3465  1.12  kiyohara 	unsigned int ier, isr;
   3466  1.12  kiyohara 	ier = slhci_read(ssc, SL11_IER);
   3467  1.12  kiyohara 	isr = slhci_read(ssc, SL11_ISR);
   3468  1.12  kiyohara 	printf("IER: %#x ISR: %#x \n", ier, isr);
   3469  1.12  kiyohara }
   3470  1.12  kiyohara 
   3471  1.12  kiyohara #if 0
   3472  1.12  kiyohara void
   3473  1.22    cegger slhci_log_sc(void)
   3474  1.12  kiyohara {
   3475  1.12  kiyohara 	struct slhci_transfers *t;
   3476  1.12  kiyohara 	int i;
   3477  1.12  kiyohara 
   3478  1.12  kiyohara 	t = &ssc->sc_transfers;
   3479  1.12  kiyohara 
   3480  1.12  kiyohara 	DDOLOG("Flags=%#x", t->flags, 0,0,0);
   3481  1.37     skrll 	DDOLOG("a = %p Alen=%d b = %p Blen=%d", t->spipe[0], t->len[0],
   3482  1.12  kiyohara 	    t->spipe[1], t->len[1]);
   3483  1.12  kiyohara 
   3484  1.37     skrll 	for (i=0; i<=Q_MAX; i++)
   3485  1.12  kiyohara 		DDOLOG("Q %d: %p", i, gcq_first(&t->q[i]), 0,0);
   3486  1.12  kiyohara 
   3487  1.37     skrll 	DDOLOG("TIMED: %p", GCQ_ITEM(gcq_first(&t->to),
   3488  1.12  kiyohara 	    struct slhci_pipe, to), 0,0,0);
   3489  1.12  kiyohara 
   3490  1.12  kiyohara 	DDOLOG("frame=%d rootintr=%p", t->frame, t->rootintr, 0,0);
   3491  1.12  kiyohara 
   3492  1.48     skrll 	DDOLOG("ub_usepolling=%d", ssc->sc_bus.ub_usepolling, 0, 0, 0);
   3493  1.12  kiyohara }
   3494  1.12  kiyohara 
   3495  1.12  kiyohara void
   3496  1.12  kiyohara slhci_log_slreq(struct slhci_pipe *r)
   3497  1.12  kiyohara {
   3498  1.12  kiyohara 	DDOLOG("next: %p", r->q.next.sqe_next, 0,0,0);
   3499  1.12  kiyohara 	DDOLOG("xfer: %p", r->xfer, 0,0,0);
   3500  1.12  kiyohara 	DDOLOG("buffer: %p", r->buffer, 0,0,0);
   3501  1.12  kiyohara 	DDOLOG("bustime: %u", r->bustime, 0,0,0);
   3502  1.12  kiyohara 	DDOLOG("control: %#x", r->control, 0,0,0);
   3503  1.37     skrll 	DDOLOGFLAG8("control=", r->control, "Preamble", "Data Toggle",
   3504  1.12  kiyohara 	    "SOF Sync", "ISOC", "res", "Out", "Enable", "Arm");
   3505  1.12  kiyohara 	DDOLOG("pid: %#x", r->tregs[PID], 0,0,0);
   3506  1.12  kiyohara 	DDOLOG("dev: %u", r->tregs[DEV], 0,0,0);
   3507  1.12  kiyohara 	DDOLOG("len: %u", r->tregs[LEN], 0,0,0);
   3508  1.12  kiyohara 
   3509  1.12  kiyohara 	if (r->xfer)
   3510  1.12  kiyohara 		slhci_log_xfer(r->xfer);
   3511   1.1     isaki }
   3512  1.12  kiyohara #endif
   3513   1.1     isaki #endif /* SLHCI_DEBUG */
   3514  1.12  kiyohara /* End debug functions. */
   3515