BlueUSB - Bluetooth support for MBED with $2 Bluetooth dong…

Users » meathome » Code » BlueUSB

Henk Bouwman / Mbed 2 deprecated BlueUSB

Bluetooth support for MBED with $2 Bluetooth dongles. Includes a USB host and built in support for bluetooth HID devices such as mice, keyboards and wii controllers.

Dependencies: mbed

USBHost.cpp@0:a1f905acca78, 2011-03-01 (annotated)

Committer:: meathome
Date:: Tue Mar 01 12:00:17 2011 +0000
Revision:: 0:a1f905acca78

Who changed what in which revision?

User	Revision	Line number	New contents of line
meathome	0:a1f905acca78	1
meathome	0:a1f905acca78	2	/*
meathome	0:a1f905acca78	3	Copyright (c) 2010 Peter Barrett
meathome	0:a1f905acca78	4
meathome	0:a1f905acca78	5	Permission is hereby granted, free of charge, to any person obtaining a copy
meathome	0:a1f905acca78	6	of this software and associated documentation files (the "Software"), to deal
meathome	0:a1f905acca78	7	in the Software without restriction, including without limitation the rights
meathome	0:a1f905acca78	8	to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
meathome	0:a1f905acca78	9	copies of the Software, and to permit persons to whom the Software is
meathome	0:a1f905acca78	10	furnished to do so, subject to the following conditions:
meathome	0:a1f905acca78	11
meathome	0:a1f905acca78	12	The above copyright notice and this permission notice shall be included in
meathome	0:a1f905acca78	13	all copies or substantial portions of the Software.
meathome	0:a1f905acca78	14
meathome	0:a1f905acca78	15	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
meathome	0:a1f905acca78	16	IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
meathome	0:a1f905acca78	17	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
meathome	0:a1f905acca78	18	AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
meathome	0:a1f905acca78	19	LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
meathome	0:a1f905acca78	20	OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
meathome	0:a1f905acca78	21	THE SOFTWARE.
meathome	0:a1f905acca78	22	*/
meathome	0:a1f905acca78	23
meathome	0:a1f905acca78	24	#include "mbed.h"
meathome	0:a1f905acca78	25	#include "USBHost.h"
meathome	0:a1f905acca78	26
meathome	0:a1f905acca78	27	// Config (default uses x bytes)
meathome	0:a1f905acca78	28	#define MAX_DEVICES 8 // Max number of devices
meathome	0:a1f905acca78	29	#define MAX_ENDPOINTS_TOTAL 16 // Max number of endpoints total
meathome	0:a1f905acca78	30	#define MAX_ENDPOINTS_PER_DEVICE 8 // Max number of endpoints for any one device
meathome	0:a1f905acca78	31
meathome	0:a1f905acca78	32	#define USBLOG 1
meathome	0:a1f905acca78	33	#if USBLOG
meathome	0:a1f905acca78	34	#define LOG(...) printf(__VA_ARGS__)
meathome	0:a1f905acca78	35	#else
meathome	0:a1f905acca78	36	#define LOG(...) do {} while(0)
meathome	0:a1f905acca78	37	#endif
meathome	0:a1f905acca78	38
meathome	0:a1f905acca78	39	// USB host structures
meathome	0:a1f905acca78	40
meathome	0:a1f905acca78	41	#define USB_RAM_SIZE 16*1024 // AHB SRAM block 1 TODO MACHINE DEPENDENT
meathome	0:a1f905acca78	42	#define USB_RAM_BASE 0x2007C000
meathome	0:a1f905acca78	43
meathome	0:a1f905acca78	44	#define TOKEN_SETUP 0
meathome	0:a1f905acca78	45	#define TOKEN_IN 1
meathome	0:a1f905acca78	46	#define TOKEN_OUT 2
meathome	0:a1f905acca78	47
meathome	0:a1f905acca78	48	// Status flags from hub
meathome	0:a1f905acca78	49	#define PORT_CONNECTION 0
meathome	0:a1f905acca78	50	#define PORT_ENABLE 1
meathome	0:a1f905acca78	51	#define PORT_SUSPEND 2
meathome	0:a1f905acca78	52	#define PORT_OVER_CURRENT 3
meathome	0:a1f905acca78	53	#define PORT_RESET 4
meathome	0:a1f905acca78	54	#define PORT_POWER 8
meathome	0:a1f905acca78	55	#define PORT_LOW_SPEED 9
meathome	0:a1f905acca78	56
meathome	0:a1f905acca78	57	#define C_PORT_CONNECTION 16
meathome	0:a1f905acca78	58	#define C_PORT_ENABLE 17
meathome	0:a1f905acca78	59	#define C_PORT_SUSPEND 18
meathome	0:a1f905acca78	60	#define C_PORT_OVER_CURRENT 19
meathome	0:a1f905acca78	61	#define C_PORT_RESET 20
meathome	0:a1f905acca78	62
meathome	0:a1f905acca78	63	typedef struct {
meathome	0:a1f905acca78	64	u8 bm_request_type;
meathome	0:a1f905acca78	65	u8 b_request;
meathome	0:a1f905acca78	66	u16 w_value;
meathome	0:a1f905acca78	67	u16 w_index;
meathome	0:a1f905acca78	68	u16 w_length;
meathome	0:a1f905acca78	69	} Setup;
meathome	0:a1f905acca78	70
meathome	0:a1f905acca78	71
meathome	0:a1f905acca78	72	// Hub stuff is kept private just to keep api simple
meathome	0:a1f905acca78	73	int SetPortFeature(int device, int feature, int index);
meathome	0:a1f905acca78	74	int ClearPortFeature(int device, int feature, int index);
meathome	0:a1f905acca78	75	int SetPortPower(int device, int port);
meathome	0:a1f905acca78	76	int SetPortReset(int device, int port);
meathome	0:a1f905acca78	77	int GetPortStatus(int device, int port, u32* status);
meathome	0:a1f905acca78	78
meathome	0:a1f905acca78	79	//===================================================================
meathome	0:a1f905acca78	80	//===================================================================
meathome	0:a1f905acca78	81	// Hardware defines
meathome	0:a1f905acca78	82
meathome	0:a1f905acca78	83	// HcControl
meathome	0:a1f905acca78	84	#define PeriodicListEnable 0x00000004
meathome	0:a1f905acca78	85	#define IsochronousEnable 0x00000008
meathome	0:a1f905acca78	86	#define ControlListEnable 0x00000010
meathome	0:a1f905acca78	87	#define BulkListEnable 0x00000020
meathome	0:a1f905acca78	88	#define OperationalMask 0x00000080
meathome	0:a1f905acca78	89	#define HostControllerFunctionalState 0x000000C0
meathome	0:a1f905acca78	90
meathome	0:a1f905acca78	91	// HcCommandStatus
meathome	0:a1f905acca78	92	#define HostControllerReset 0x00000001
meathome	0:a1f905acca78	93	#define ControlListFilled 0x00000002
meathome	0:a1f905acca78	94	#define BulkListFilled 0x00000004
meathome	0:a1f905acca78	95
meathome	0:a1f905acca78	96	// HcInterruptStatus Register
meathome	0:a1f905acca78	97	#define WritebackDoneHead 0x00000002
meathome	0:a1f905acca78	98	#define StartofFrame 0x00000004
meathome	0:a1f905acca78	99	#define ResumeDetected 0x00000008
meathome	0:a1f905acca78	100	#define UnrecoverableError 0x00000010
meathome	0:a1f905acca78	101	#define FrameNumberOverflow 0x00000020
meathome	0:a1f905acca78	102	#define RootHubStatusChange 0x00000040
meathome	0:a1f905acca78	103	#define OwnershipChange 0x00000080
meathome	0:a1f905acca78	104	#define MasterInterruptEnable 0x80000000
meathome	0:a1f905acca78	105
meathome	0:a1f905acca78	106	// HcRhStatus
meathome	0:a1f905acca78	107	#define SetGlobalPower 0x00010000
meathome	0:a1f905acca78	108	#define DeviceRemoteWakeupEnable 0x00008000
meathome	0:a1f905acca78	109
meathome	0:a1f905acca78	110	// HcRhPortStatus (hub 0, port 1)
meathome	0:a1f905acca78	111	#define CurrentConnectStatus 0x00000001
meathome	0:a1f905acca78	112	#define PortEnableStatus 0x00000002
meathome	0:a1f905acca78	113	#define PortSuspendStatus 0x00000004
meathome	0:a1f905acca78	114	#define PortOverCurrentIndicator 0x00000008
meathome	0:a1f905acca78	115	#define PortResetStatus 0x00000010
meathome	0:a1f905acca78	116
meathome	0:a1f905acca78	117	#define PortPowerStatus 0x00000100
meathome	0:a1f905acca78	118	#define LowspeedDevice 0x00000200
meathome	0:a1f905acca78	119	#define HighspeedDevice 0x00000400
meathome	0:a1f905acca78	120
meathome	0:a1f905acca78	121	#define ConnectStatusChange (CurrentConnectStatus << 16)
meathome	0:a1f905acca78	122	#define PortResetStatusChange (PortResetStatus << 16)
meathome	0:a1f905acca78	123
meathome	0:a1f905acca78	124
meathome	0:a1f905acca78	125	#define TD_ROUNDING (u32)0x00040000
meathome	0:a1f905acca78	126	#define TD_SETUP (u32)0x00000000
meathome	0:a1f905acca78	127	#define TD_IN (u32)0x00100000
meathome	0:a1f905acca78	128	#define TD_OUT (u32)0x00080000
meathome	0:a1f905acca78	129	#define TD_DELAY_INT(x) (u32)((x) << 21)
meathome	0:a1f905acca78	130	#define TD_TOGGLE_0 (u32)0x02000000
meathome	0:a1f905acca78	131	#define TD_TOGGLE_1 (u32)0x03000000
meathome	0:a1f905acca78	132	#define TD_CC (u32)0xF0000000
meathome	0:a1f905acca78	133
meathome	0:a1f905acca78	134	// HostController EndPoint Descriptor
meathome	0:a1f905acca78	135	typedef struct {
meathome	0:a1f905acca78	136	volatile u32 Control;
meathome	0:a1f905acca78	137	volatile u32 TailTd;
meathome	0:a1f905acca78	138	volatile u32 HeadTd;
meathome	0:a1f905acca78	139	volatile u32 Next;
meathome	0:a1f905acca78	140	} HCED;
meathome	0:a1f905acca78	141
meathome	0:a1f905acca78	142	// HostController Transfer Descriptor
meathome	0:a1f905acca78	143	typedef struct {
meathome	0:a1f905acca78	144	volatile u32 Control;
meathome	0:a1f905acca78	145	volatile u32 CurrBufPtr;
meathome	0:a1f905acca78	146	volatile u32 Next;
meathome	0:a1f905acca78	147	volatile u32 BufEnd;
meathome	0:a1f905acca78	148	} HCTD;
meathome	0:a1f905acca78	149
meathome	0:a1f905acca78	150	// Host Controller Communication Area
meathome	0:a1f905acca78	151	typedef struct {
meathome	0:a1f905acca78	152	volatile u32 InterruptTable[32];
meathome	0:a1f905acca78	153	volatile u16 FrameNumber;
meathome	0:a1f905acca78	154	volatile u16 FrameNumberPad;
meathome	0:a1f905acca78	155	volatile u32 DoneHead;
meathome	0:a1f905acca78	156	volatile u8 Reserved[120];
meathome	0:a1f905acca78	157	} HCCA;
meathome	0:a1f905acca78	158
meathome	0:a1f905acca78	159	//====================================================================================
meathome	0:a1f905acca78	160	//====================================================================================
meathome	0:a1f905acca78	161
meathome	0:a1f905acca78	162	class HostController;
meathome	0:a1f905acca78	163	class Endpoint;
meathome	0:a1f905acca78	164	class Device;
meathome	0:a1f905acca78	165
meathome	0:a1f905acca78	166	// must be 3*16 bytes long
meathome	0:a1f905acca78	167	class Endpoint
meathome	0:a1f905acca78	168	{
meathome	0:a1f905acca78	169	public:
meathome	0:a1f905acca78	170	HCED EndpointDescriptor; // Pointer to EndpointDescriptor == Pointer to Endpoint
meathome	0:a1f905acca78	171	HCTD TDHead;
meathome	0:a1f905acca78	172
meathome	0:a1f905acca78	173	enum State
meathome	0:a1f905acca78	174	{
meathome	0:a1f905acca78	175	Free,
meathome	0:a1f905acca78	176	NotQueued,
meathome	0:a1f905acca78	177	Idle,
meathome	0:a1f905acca78	178	SetupQueued,
meathome	0:a1f905acca78	179	DataQueued,
meathome	0:a1f905acca78	180	StatusQueued,
meathome	0:a1f905acca78	181	CallbackPending
meathome	0:a1f905acca78	182	};
meathome	0:a1f905acca78	183
meathome	0:a1f905acca78	184	volatile u8 CurrentState;
meathome	0:a1f905acca78	185	u8 Flags; // 0x80 In, 0x03 mask endpoint type
meathome	0:a1f905acca78	186
meathome	0:a1f905acca78	187	u16 Length;
meathome	0:a1f905acca78	188	u8* Data;
meathome	0:a1f905acca78	189	USBCallback Callback; // Must be a multiple of 16 bytes long
meathome	0:a1f905acca78	190	void* UserData;
meathome	0:a1f905acca78	191
meathome	0:a1f905acca78	192	int Address()
meathome	0:a1f905acca78	193	{
meathome	0:a1f905acca78	194	int ep = (EndpointDescriptor.Control >> 7) & 0xF;
meathome	0:a1f905acca78	195	if (ep)
meathome	0:a1f905acca78	196	ep \|= Flags & 0x80;
meathome	0:a1f905acca78	197	return ep;
meathome	0:a1f905acca78	198	}
meathome	0:a1f905acca78	199
meathome	0:a1f905acca78	200	int Device()
meathome	0:a1f905acca78	201	{
meathome	0:a1f905acca78	202	return EndpointDescriptor.Control & 0x7F;
meathome	0:a1f905acca78	203	}
meathome	0:a1f905acca78	204
meathome	0:a1f905acca78	205	int Status()
meathome	0:a1f905acca78	206	{
meathome	0:a1f905acca78	207	return (TDHead.Control >> 28) & 0xF;
meathome	0:a1f905acca78	208	}
meathome	0:a1f905acca78	209
meathome	0:a1f905acca78	210	u32 Enqueue(u32 head)
meathome	0:a1f905acca78	211	{
meathome	0:a1f905acca78	212	if (CurrentState == NotQueued)
meathome	0:a1f905acca78	213	{
meathome	0:a1f905acca78	214	EndpointDescriptor.Next = head;
meathome	0:a1f905acca78	215	head = (u32)&EndpointDescriptor;
meathome	0:a1f905acca78	216	CurrentState = Idle;
meathome	0:a1f905acca78	217	}
meathome	0:a1f905acca78	218	return head;
meathome	0:a1f905acca78	219	}
meathome	0:a1f905acca78	220	};
meathome	0:a1f905acca78	221
meathome	0:a1f905acca78	222	class Device
meathome	0:a1f905acca78	223	{
meathome	0:a1f905acca78	224	public:
meathome	0:a1f905acca78	225	u8 _endpointMap[MAX_ENDPOINTS_PER_DEVICE*2];
meathome	0:a1f905acca78	226	u8 Hub;
meathome	0:a1f905acca78	227	u8 Port;
meathome	0:a1f905acca78	228	u8 Addr;
meathome	0:a1f905acca78	229	u8 Pad;
meathome	0:a1f905acca78	230
meathome	0:a1f905acca78	231	// Only if this device is a hub
meathome	0:a1f905acca78	232	u8 HubPortCount; // nonzero if this is a hub
meathome	0:a1f905acca78	233	u8 HubInterruptData;
meathome	0:a1f905acca78	234	u8 HubMap;
meathome	0:a1f905acca78	235	u8 HubMask;
meathome	0:a1f905acca78	236
meathome	0:a1f905acca78	237	int Flags; // 1 = Disconnected
meathome	0:a1f905acca78	238
meathome	0:a1f905acca78	239	Setup SetupBuffer;
meathome	0:a1f905acca78	240
meathome	0:a1f905acca78	241	// Allocate endpoint zero
meathome	0:a1f905acca78	242	int Init(DeviceDescriptor* d, int hub, int port, int addr, int lowSpeed)
meathome	0:a1f905acca78	243	{
meathome	0:a1f905acca78	244	Hub = hub;
meathome	0:a1f905acca78	245	Port = port;
meathome	0:a1f905acca78	246	Addr = addr;
meathome	0:a1f905acca78	247	Flags = lowSpeed;
meathome	0:a1f905acca78	248	memset(_endpointMap,0xFF,sizeof(_endpointMap));
meathome	0:a1f905acca78	249	return 0;
meathome	0:a1f905acca78	250	}
meathome	0:a1f905acca78	251
meathome	0:a1f905acca78	252	int SetEndpointIndex(int ep, int endpointIndex)
meathome	0:a1f905acca78	253	{
meathome	0:a1f905acca78	254	for (int i = 0; i < MAX_ENDPOINTS_PER_DEVICE*2; i += 2)
meathome	0:a1f905acca78	255	{
meathome	0:a1f905acca78	256	if (_endpointMap[i] == 0xFF) // Add endpoint to map
meathome	0:a1f905acca78	257	{
meathome	0:a1f905acca78	258	_endpointMap[i] = ep;
meathome	0:a1f905acca78	259	_endpointMap[i+1] = endpointIndex;
meathome	0:a1f905acca78	260	return 0;
meathome	0:a1f905acca78	261	}
meathome	0:a1f905acca78	262	}
meathome	0:a1f905acca78	263	return ERR_ENDPOINT_NONE_LEFT;
meathome	0:a1f905acca78	264	}
meathome	0:a1f905acca78	265
meathome	0:a1f905acca78	266	int GetEndpointIndex(int ep)
meathome	0:a1f905acca78	267	{
meathome	0:a1f905acca78	268	for (int i = 0; i < MAX_ENDPOINTS_PER_DEVICE*2; i += 2)
meathome	0:a1f905acca78	269	{
meathome	0:a1f905acca78	270	if (_endpointMap[i] == ep)
meathome	0:a1f905acca78	271	return _endpointMap[i+1];
meathome	0:a1f905acca78	272	if (_endpointMap[i] == 0xFF)
meathome	0:a1f905acca78	273	break;
meathome	0:a1f905acca78	274	}
meathome	0:a1f905acca78	275	return -1;
meathome	0:a1f905acca78	276	}
meathome	0:a1f905acca78	277	};
meathome	0:a1f905acca78	278
meathome	0:a1f905acca78	279	class HostController
meathome	0:a1f905acca78	280	{
meathome	0:a1f905acca78	281	public:
meathome	0:a1f905acca78	282	HCCA CommunicationArea;
meathome	0:a1f905acca78	283	Endpoint Endpoints[MAX_ENDPOINTS_TOTAL]; // Multiple of 16
meathome	0:a1f905acca78	284
meathome	0:a1f905acca78	285	Endpoint EndpointZero; // For device enumeration
meathome	0:a1f905acca78	286	HCTD _commonTail;
meathome	0:a1f905acca78	287	Setup _setupZero;
meathome	0:a1f905acca78	288
meathome	0:a1f905acca78	289	Device Devices[MAX_DEVICES];
meathome	0:a1f905acca78	290	u32 _frameNumber; // 32 bit ms counter
meathome	0:a1f905acca78	291
meathome	0:a1f905acca78	292	u8 _callbacksPending; // Endpoints with callbacks are pending, set from ISR via ProcessDoneQueue
meathome	0:a1f905acca78	293	u8 _rootHubStatusChange; // Root hub status has changed, set from ISR
meathome	0:a1f905acca78	294	u8 _unused0;
meathome	0:a1f905acca78	295	u8 _unused1;
meathome	0:a1f905acca78	296
meathome	0:a1f905acca78	297	u8 _connectPending; // Reset has initiated a connect
meathome	0:a1f905acca78	298	u8 _connectCountdown; // Number of ms left after reset before we can connect
meathome	0:a1f905acca78	299	u8 _connectHub; // Will connect on this hub
meathome	0:a1f905acca78	300	u8 _connectPort; // ... and this port
meathome	0:a1f905acca78	301
meathome	0:a1f905acca78	302	u8 SRAM[0]; // Start of free SRAM
meathome	0:a1f905acca78	303
meathome	0:a1f905acca78	304	void Loop()
meathome	0:a1f905acca78	305	{
meathome	0:a1f905acca78	306	u16 elapsed = CommunicationArea.FrameNumber - (u16)_frameNumber; // extend to 32 bits
meathome	0:a1f905acca78	307	_frameNumber += elapsed;
meathome	0:a1f905acca78	308
meathome	0:a1f905acca78	309	// Do callbacks, if any
meathome	0:a1f905acca78	310	while (_callbacksPending)
meathome	0:a1f905acca78	311	{
meathome	0:a1f905acca78	312	for (int i = 0; i < MAX_ENDPOINTS_TOTAL; i++)
meathome	0:a1f905acca78	313	{
meathome	0:a1f905acca78	314	Endpoint* endpoint = Endpoints + i;
meathome	0:a1f905acca78	315	if (endpoint->CurrentState == Endpoint::CallbackPending)
meathome	0:a1f905acca78	316	{
meathome	0:a1f905acca78	317	_callbacksPending--;
meathome	0:a1f905acca78	318	endpoint->CurrentState = Endpoint::Idle;
meathome	0:a1f905acca78	319	endpoint->Callback(endpoint->Device(),endpoint->Address(),endpoint->Status(),endpoint->Data,endpoint->Length,endpoint->UserData);
meathome	0:a1f905acca78	320	}
meathome	0:a1f905acca78	321	}
meathome	0:a1f905acca78	322	}
meathome	0:a1f905acca78	323
meathome	0:a1f905acca78	324	// Deal with changes on the root hub
meathome	0:a1f905acca78	325	if (_rootHubStatusChange)
meathome	0:a1f905acca78	326	{
meathome	0:a1f905acca78	327	u32 status = LPC_USB->HcRhPortStatus1;
meathome	0:a1f905acca78	328	_rootHubStatusChange = 0;
meathome	0:a1f905acca78	329	if (status >> 16)
meathome	0:a1f905acca78	330	{
meathome	0:a1f905acca78	331	HubStatusChange(0,1,status);
meathome	0:a1f905acca78	332	LPC_USB->HcRhPortStatus1 = status & 0xFFFF0000; // clear status changes
meathome	0:a1f905acca78	333	}
meathome	0:a1f905acca78	334	}
meathome	0:a1f905acca78	335
meathome	0:a1f905acca78	336	// Connect after reset timeout
meathome	0:a1f905acca78	337	if (_connectCountdown)
meathome	0:a1f905acca78	338	{
meathome	0:a1f905acca78	339	if (elapsed >= _connectCountdown)
meathome	0:a1f905acca78	340	{
meathome	0:a1f905acca78	341	_connectCountdown = 0;
meathome	0:a1f905acca78	342	Connect(_connectHub,_connectPort & 0x7F,_connectPort & 0x80);
meathome	0:a1f905acca78	343	} else
meathome	0:a1f905acca78	344	_connectCountdown -= elapsed;
meathome	0:a1f905acca78	345	}
meathome	0:a1f905acca78	346	}
meathome	0:a1f905acca78	347
meathome	0:a1f905acca78	348	// HubInterrupt - bitmap in dev->HubInterruptData
meathome	0:a1f905acca78	349	void HubInterrupt(int device)
meathome	0:a1f905acca78	350	{
meathome	0:a1f905acca78	351	Device* dev = &Devices[device-1];
meathome	0:a1f905acca78	352	for (int i = 0; i < dev->HubPortCount; i++)
meathome	0:a1f905acca78	353	{
meathome	0:a1f905acca78	354	int port = i+1;
meathome	0:a1f905acca78	355	if (dev->HubInterruptData & (1 << port))
meathome	0:a1f905acca78	356	{
meathome	0:a1f905acca78	357	u32 status = 0;
meathome	0:a1f905acca78	358	GetPortStatus(device,port,&status);
meathome	0:a1f905acca78	359	if (status >> 16)
meathome	0:a1f905acca78	360	{
meathome	0:a1f905acca78	361	if (_connectPending && (status & ConnectStatusChange))
meathome	0:a1f905acca78	362	continue; // Don't connect again until previous device has been added and addressed
meathome	0:a1f905acca78	363
meathome	0:a1f905acca78	364	HubStatusChange(device,port,status);
meathome	0:a1f905acca78	365	if (status & ConnectStatusChange)
meathome	0:a1f905acca78	366	ClearPortFeature(device,C_PORT_CONNECTION,port);
meathome	0:a1f905acca78	367	if (status & PortResetStatusChange)
meathome	0:a1f905acca78	368	ClearPortFeature(device,C_PORT_RESET,port);
meathome	0:a1f905acca78	369	}
meathome	0:a1f905acca78	370	}
meathome	0:a1f905acca78	371	}
meathome	0:a1f905acca78	372	}
meathome	0:a1f905acca78	373
meathome	0:a1f905acca78	374	static void HubInterruptCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
meathome	0:a1f905acca78	375	{
meathome	0:a1f905acca78	376	HostController* controller = (HostController*)userData;
meathome	0:a1f905acca78	377	if (status == 0)
meathome	0:a1f905acca78	378	controller->HubInterrupt(device);
meathome	0:a1f905acca78	379	USBInterruptTransfer(device,endpoint,data,1,HubInterruptCallback,userData);
meathome	0:a1f905acca78	380	}
meathome	0:a1f905acca78	381
meathome	0:a1f905acca78	382	int InitHub(int device)
meathome	0:a1f905acca78	383	{
meathome	0:a1f905acca78	384	u8 buf[16];
meathome	0:a1f905acca78	385	int r= USBControlTransfer(device,DEVICE_TO_HOST \| REQUEST_TYPE_CLASS \| RECIPIENT_DEVICE,GET_DESCRIPTOR,(DESCRIPTOR_TYPE_HUB << 8),0,buf,sizeof(buf));
meathome	0:a1f905acca78	386	if (r < 0)
meathome	0:a1f905acca78	387	return ERR_HUB_INIT_FAILED;
meathome	0:a1f905acca78	388
meathome	0:a1f905acca78	389	// turn on power on the hubs ports
meathome	0:a1f905acca78	390	Device* dev = &Devices[device-1];
meathome	0:a1f905acca78	391	int ports = buf[2];
meathome	0:a1f905acca78	392	dev->HubPortCount = ports;
meathome	0:a1f905acca78	393	for (int i = 0; i < ports; i++)
meathome	0:a1f905acca78	394	SetPortPower(device,i+1);
meathome	0:a1f905acca78	395
meathome	0:a1f905acca78	396	// Enable hub change interrupts
meathome	0:a1f905acca78	397	return USBInterruptTransfer(device,0x81,&dev->HubInterruptData,1,HubInterruptCallback,this);
meathome	0:a1f905acca78	398	}
meathome	0:a1f905acca78	399
meathome	0:a1f905acca78	400	int AddEndpoint(int device, int ep, int attributes, int maxPacketSize, int interval)
meathome	0:a1f905acca78	401	{
meathome	0:a1f905acca78	402	LOG("AddEndpoint D:%02X A:%02X T:%02X P:%04X I:%02X\n",device,ep,attributes,maxPacketSize,interval);
meathome	0:a1f905acca78	403	Device* dev = &Devices[device-1];
meathome	0:a1f905acca78	404	Endpoint* endpoint = AllocateEndpoint(device,ep,attributes,maxPacketSize);
meathome	0:a1f905acca78	405	if (!endpoint)
meathome	0:a1f905acca78	406	return ERR_ENDPOINT_NONE_LEFT;
meathome	0:a1f905acca78	407	dev->SetEndpointIndex(ep,endpoint - Endpoints);
meathome	0:a1f905acca78	408	endpoint->EndpointDescriptor.Control \|= dev->Flags; // Map in slow speed
meathome	0:a1f905acca78	409	return 0; // TODO ed->bInterval
meathome	0:a1f905acca78	410	}
meathome	0:a1f905acca78	411
meathome	0:a1f905acca78	412	int AddEndpoint(int device, EndpointDescriptor* ed)
meathome	0:a1f905acca78	413	{
meathome	0:a1f905acca78	414	return AddEndpoint(device,ed->bEndpointAddress,ed->bmAttributes,ed->wMaxPacketSize,ed->bInterval);
meathome	0:a1f905acca78	415	}
meathome	0:a1f905acca78	416
meathome	0:a1f905acca78	417	// allocate a endpoint
meathome	0:a1f905acca78	418	Endpoint* AllocateEndpoint(int device, int endpointAddress, int type, int maxPacketSize)
meathome	0:a1f905acca78	419	{
meathome	0:a1f905acca78	420	for (int i = 0; i < MAX_ENDPOINTS_TOTAL; i++)
meathome	0:a1f905acca78	421	{
meathome	0:a1f905acca78	422	Endpoint* ep = &Endpoints[i];
meathome	0:a1f905acca78	423	if (ep->CurrentState == 0)
meathome	0:a1f905acca78	424	{
meathome	0:a1f905acca78	425	//LOG("Allocated endpoint %d to %02X:%02X\n",i,device,endpointAddress);
meathome	0:a1f905acca78	426	ep->Flags = (endpointAddress & 0x80) \| (type & 3);
meathome	0:a1f905acca78	427	ep->CurrentState = Endpoint::NotQueued;
meathome	0:a1f905acca78	428	ep->EndpointDescriptor.Control = (maxPacketSize << 16) \| ((endpointAddress & 0x7F) << 7) \| device;
meathome	0:a1f905acca78	429	return ep;
meathome	0:a1f905acca78	430	}
meathome	0:a1f905acca78	431	}
meathome	0:a1f905acca78	432	return 0;
meathome	0:a1f905acca78	433	}
meathome	0:a1f905acca78	434
meathome	0:a1f905acca78	435	Endpoint* GetEndpoint(int device, int ep)
meathome	0:a1f905acca78	436	{
meathome	0:a1f905acca78	437	if (device == 0)
meathome	0:a1f905acca78	438	{
meathome	0:a1f905acca78	439	//printf("WARNING: USING DEVICE 0\n");
meathome	0:a1f905acca78	440	return &EndpointZero;
meathome	0:a1f905acca78	441	}
meathome	0:a1f905acca78	442	if (device > MAX_DEVICES)
meathome	0:a1f905acca78	443	return 0;
meathome	0:a1f905acca78	444	int i = Devices[device-1].GetEndpointIndex(ep);
meathome	0:a1f905acca78	445	if (i == -1)
meathome	0:a1f905acca78	446	return 0;
meathome	0:a1f905acca78	447	return Endpoints + i;
meathome	0:a1f905acca78	448	}
meathome	0:a1f905acca78	449
meathome	0:a1f905acca78	450	int Transfer(Endpoint* endpoint, int token, u8* data, int len, int state)
meathome	0:a1f905acca78	451	{
meathome	0:a1f905acca78	452	//LOG("Transfer %02X T:%d Len:%d S:%d\n",endpoint->Address(),token,len,state);
meathome	0:a1f905acca78	453
meathome	0:a1f905acca78	454	int toggle = 0;
meathome	0:a1f905acca78	455	if (endpoint->Address() == 0)
meathome	0:a1f905acca78	456	toggle = (token == TOKEN_SETUP) ? TD_TOGGLE_0 : TD_TOGGLE_1;
meathome	0:a1f905acca78	457
meathome	0:a1f905acca78	458	if (token != TOKEN_SETUP)
meathome	0:a1f905acca78	459	token = (token == TOKEN_IN ? TD_IN : TD_OUT);
meathome	0:a1f905acca78	460
meathome	0:a1f905acca78	461	HCTD* head = &endpoint->TDHead;
meathome	0:a1f905acca78	462	HCTD* tail = &_commonTail;
meathome	0:a1f905acca78	463
meathome	0:a1f905acca78	464	head->Control = TD_ROUNDING \| token \| TD_DELAY_INT(0) \| toggle \| TD_CC;
meathome	0:a1f905acca78	465	head->CurrBufPtr = (u32)data;
meathome	0:a1f905acca78	466	head->BufEnd = (u32)(data + len - 1);
meathome	0:a1f905acca78	467	head->Next = (u32)tail;
meathome	0:a1f905acca78	468
meathome	0:a1f905acca78	469	HCED* ed = &endpoint->EndpointDescriptor;
meathome	0:a1f905acca78	470	ed->HeadTd = (u32)head \| (ed->HeadTd & 0x00000002); // carry toggle
meathome	0:a1f905acca78	471	ed->TailTd = (u32)tail;
meathome	0:a1f905acca78	472
meathome	0:a1f905acca78	473	//HCTD* td = head;
meathome	0:a1f905acca78	474	//LOG("%04X TD %08X %08X %08X Next:%08X\n",CommunicationArea.FrameNumber,td->Control,td->CurrBufPtr,td->BufEnd,td->Next);
meathome	0:a1f905acca78	475	//LOG("%04X ED %08X %08X %08X\n",CommunicationArea.FrameNumber,ed->Control,ed->HeadTd,ed->TailTd);
meathome	0:a1f905acca78	476
meathome	0:a1f905acca78	477	switch (endpoint->Flags & 3)
meathome	0:a1f905acca78	478	{
meathome	0:a1f905acca78	479	case ENDPOINT_CONTROL:
meathome	0:a1f905acca78	480	LPC_USB->HcControlHeadED = endpoint->Enqueue(LPC_USB->HcControlHeadED); // May change state NotQueued->Idle
meathome	0:a1f905acca78	481	endpoint->CurrentState = state; // Get in before an int
meathome	0:a1f905acca78	482	LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus \| ControlListFilled;
meathome	0:a1f905acca78	483	LPC_USB->HcControl = LPC_USB->HcControl \| ControlListEnable;
meathome	0:a1f905acca78	484	break;
meathome	0:a1f905acca78	485
meathome	0:a1f905acca78	486	case ENDPOINT_BULK:
meathome	0:a1f905acca78	487	LPC_USB->HcBulkHeadED = endpoint->Enqueue(LPC_USB->HcBulkHeadED);
meathome	0:a1f905acca78	488	endpoint->CurrentState = state;
meathome	0:a1f905acca78	489	LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus \| BulkListFilled;
meathome	0:a1f905acca78	490	LPC_USB->HcControl = LPC_USB->HcControl \| BulkListEnable;
meathome	0:a1f905acca78	491	break;
meathome	0:a1f905acca78	492
meathome	0:a1f905acca78	493	case ENDPOINT_INTERRUPT:
meathome	0:a1f905acca78	494	CommunicationArea.InterruptTable[0] = endpoint->Enqueue(CommunicationArea.InterruptTable[0]);
meathome	0:a1f905acca78	495	endpoint->CurrentState = state;
meathome	0:a1f905acca78	496	LPC_USB->HcControl \|= PeriodicListEnable;
meathome	0:a1f905acca78	497	break;
meathome	0:a1f905acca78	498	}
meathome	0:a1f905acca78	499	return 0;
meathome	0:a1f905acca78	500	}
meathome	0:a1f905acca78	501
meathome	0:a1f905acca78	502	// Remove an endpoint from an active queue
meathome	0:a1f905acca78	503	bool Remove(HCED* ed, volatile HCED** queue)
meathome	0:a1f905acca78	504	{
meathome	0:a1f905acca78	505	if (*queue == 0)
meathome	0:a1f905acca78	506	return false;
meathome	0:a1f905acca78	507	if (queue == (volatile HCED)ed)
meathome	0:a1f905acca78	508	{
meathome	0:a1f905acca78	509	queue = (volatile HCED)ed->Next; // At head of queue
meathome	0:a1f905acca78	510	return true;
meathome	0:a1f905acca78	511	}
meathome	0:a1f905acca78	512
meathome	0:a1f905acca78	513	volatile HCED* head = *queue;
meathome	0:a1f905acca78	514	while (head)
meathome	0:a1f905acca78	515	{
meathome	0:a1f905acca78	516	if (head->Next == (u32)ed)
meathome	0:a1f905acca78	517	{
meathome	0:a1f905acca78	518	head->Next = ed->Next;
meathome	0:a1f905acca78	519	return true;
meathome	0:a1f905acca78	520	}
meathome	0:a1f905acca78	521	head = (volatile HCED*)head->Next;
meathome	0:a1f905acca78	522	}
meathome	0:a1f905acca78	523	return false;
meathome	0:a1f905acca78	524	}
meathome	0:a1f905acca78	525
meathome	0:a1f905acca78	526	void Release(Endpoint* endpoint)
meathome	0:a1f905acca78	527	{
meathome	0:a1f905acca78	528	if (endpoint->CurrentState == Endpoint::NotQueued)
meathome	0:a1f905acca78	529	{
meathome	0:a1f905acca78	530	// Never event used it, nothing to do
meathome	0:a1f905acca78	531	}
meathome	0:a1f905acca78	532	else
meathome	0:a1f905acca78	533	{
meathome	0:a1f905acca78	534	HCED* ed = (HCED*)endpoint;
meathome	0:a1f905acca78	535	ed->Control \|= 0x4000; // SKIP
meathome	0:a1f905acca78	536	switch (endpoint->Flags & 0x03)
meathome	0:a1f905acca78	537	{
meathome	0:a1f905acca78	538	case ENDPOINT_CONTROL:
meathome	0:a1f905acca78	539	Remove(ed,(volatile HCED**)&LPC_USB->HcControlHeadED);
meathome	0:a1f905acca78	540	break;
meathome	0:a1f905acca78	541	case ENDPOINT_BULK:
meathome	0:a1f905acca78	542	Remove(ed,(volatile HCED**)&LPC_USB->HcBulkHeadED);
meathome	0:a1f905acca78	543	break;
meathome	0:a1f905acca78	544	case ENDPOINT_INTERRUPT:
meathome	0:a1f905acca78	545	for (int i = 0; i < 32; i++)
meathome	0:a1f905acca78	546	Remove(ed,(volatile HCED**)&CommunicationArea.InterruptTable[i]);
meathome	0:a1f905acca78	547	break;
meathome	0:a1f905acca78	548	}
meathome	0:a1f905acca78	549
meathome	0:a1f905acca78	550	u16 fn = CommunicationArea.FrameNumber;
meathome	0:a1f905acca78	551	while (fn == CommunicationArea.FrameNumber)
meathome	0:a1f905acca78	552	; // Wait for next frame
meathome	0:a1f905acca78	553
meathome	0:a1f905acca78	554	}
meathome	0:a1f905acca78	555
meathome	0:a1f905acca78	556	// In theory, the endpoint is now dead.
meathome	0:a1f905acca78	557	// TODO: Will Callbacks ever be pending? BUGBUG
meathome	0:a1f905acca78	558	memset(endpoint,0,sizeof(Endpoint));
meathome	0:a1f905acca78	559	}
meathome	0:a1f905acca78	560
meathome	0:a1f905acca78	561	// Pop the last TD from the list
meathome	0:a1f905acca78	562	HCTD* Reverse(HCTD* current)
meathome	0:a1f905acca78	563	{
meathome	0:a1f905acca78	564	HCTD result = NULL,temp;
meathome	0:a1f905acca78	565	while (current)
meathome	0:a1f905acca78	566	{
meathome	0:a1f905acca78	567	temp = (HCTD*)current->Next;
meathome	0:a1f905acca78	568	current->Next = (u32)result;
meathome	0:a1f905acca78	569	result = current;
meathome	0:a1f905acca78	570	current = temp;
meathome	0:a1f905acca78	571	}
meathome	0:a1f905acca78	572	return result;
meathome	0:a1f905acca78	573	}
meathome	0:a1f905acca78	574
meathome	0:a1f905acca78	575	// Called from interrupt...
meathome	0:a1f905acca78	576	// Control endpoints use a state machine to progress through the transfers
meathome	0:a1f905acca78	577	void ProcessDoneQueue(u32 tdList)
meathome	0:a1f905acca78	578	{
meathome	0:a1f905acca78	579	HCTD* list = Reverse((HCTD*)tdList);
meathome	0:a1f905acca78	580	while (list)
meathome	0:a1f905acca78	581	{
meathome	0:a1f905acca78	582	Endpoint* endpoint = (Endpoint*)(list-1);
meathome	0:a1f905acca78	583	list = (HCTD*)list->Next;
meathome	0:a1f905acca78	584	int ep = endpoint->Address();
meathome	0:a1f905acca78	585	bool in = endpoint->Flags & 0x80;
meathome	0:a1f905acca78	586	int status = (endpoint->TDHead.Control >> 28) & 0xF;
meathome	0:a1f905acca78	587
meathome	0:a1f905acca78	588	//LOG("ProcessDoneQueue %02X %08X\n",ep,endpoint->TDHead.Control);
meathome	0:a1f905acca78	589
meathome	0:a1f905acca78	590	if (status != 0)
meathome	0:a1f905acca78	591	{
meathome	0:a1f905acca78	592	LOG("ProcessDoneQueue status %02X %d\n",ep,status);
meathome	0:a1f905acca78	593	endpoint->CurrentState = Endpoint::Idle;
meathome	0:a1f905acca78	594	} else {
meathome	0:a1f905acca78	595	switch (endpoint->CurrentState)
meathome	0:a1f905acca78	596	{
meathome	0:a1f905acca78	597	case Endpoint::SetupQueued:
meathome	0:a1f905acca78	598	if (endpoint->Length == 0)
meathome	0:a1f905acca78	599	Transfer(endpoint,in ? TOKEN_OUT : TOKEN_IN,0,0,Endpoint::StatusQueued); // Skip Data Phase
meathome	0:a1f905acca78	600	else
meathome	0:a1f905acca78	601	Transfer(endpoint,in ? TOKEN_IN : TOKEN_OUT,endpoint->Data,endpoint->Length, Endpoint::DataQueued); // Setup is done, now Data
meathome	0:a1f905acca78	602	break;
meathome	0:a1f905acca78	603
meathome	0:a1f905acca78	604	case Endpoint::DataQueued:
meathome	0:a1f905acca78	605	if (endpoint->TDHead.CurrBufPtr)
meathome	0:a1f905acca78	606	endpoint->Length = endpoint->TDHead.CurrBufPtr - (u32)endpoint->Data;
meathome	0:a1f905acca78	607
meathome	0:a1f905acca78	608	if (ep == 0)
meathome	0:a1f905acca78	609	Transfer(endpoint,in ? TOKEN_OUT : TOKEN_IN,0,0,Endpoint::StatusQueued); // Data is done, now Status, Control only
meathome	0:a1f905acca78	610	else
meathome	0:a1f905acca78	611	endpoint->CurrentState = Endpoint::Idle;
meathome	0:a1f905acca78	612	break;
meathome	0:a1f905acca78	613
meathome	0:a1f905acca78	614	case Endpoint::StatusQueued: // Transaction is done
meathome	0:a1f905acca78	615	endpoint->CurrentState = Endpoint::Idle;
meathome	0:a1f905acca78	616	break;
meathome	0:a1f905acca78	617	}
meathome	0:a1f905acca78	618	}
meathome	0:a1f905acca78	619
meathome	0:a1f905acca78	620	// Complete, flag if we need a callback
meathome	0:a1f905acca78	621	if (endpoint->Callback && endpoint->CurrentState == Endpoint::Idle)
meathome	0:a1f905acca78	622	{
meathome	0:a1f905acca78	623	endpoint->CurrentState = Endpoint::CallbackPending;
meathome	0:a1f905acca78	624	_callbacksPending++;
meathome	0:a1f905acca78	625	}
meathome	0:a1f905acca78	626	}
meathome	0:a1f905acca78	627	}
meathome	0:a1f905acca78	628
meathome	0:a1f905acca78	629	// Hack to reset devices that don't want to connect
meathome	0:a1f905acca78	630	int AddDevice(int hub, int port, bool isLowSpeed)
meathome	0:a1f905acca78	631	{
meathome	0:a1f905acca78	632	int device = AddDeviceCore(hub,port,isLowSpeed);
meathome	0:a1f905acca78	633	if (device < 0)
meathome	0:a1f905acca78	634	{
meathome	0:a1f905acca78	635	LOG("========RETRY ADD DEVICE========\n"); // This will go for ever.. TODO power cycle root?
meathome	0:a1f905acca78	636	Disconnect(hub,port); // Could not read descriptor at assigned address, reset this port and try again
meathome	0:a1f905acca78	637	ResetPort(hub,port); // Cheap bluetooth dongles often need this on a hotplug
meathome	0:a1f905acca78	638	return -1;
meathome	0:a1f905acca78	639	}
meathome	0:a1f905acca78	640	return device;
meathome	0:a1f905acca78	641	}
meathome	0:a1f905acca78	642
meathome	0:a1f905acca78	643	int AddDeviceCore(int hub, int port, bool isLowSpeed)
meathome	0:a1f905acca78	644	{
meathome	0:a1f905acca78	645	int lowSpeed = isLowSpeed ? 0x2000 : 0;
meathome	0:a1f905acca78	646	DeviceDescriptor desc;
meathome	0:a1f905acca78	647	EndpointZero.EndpointDescriptor.Control = (8 << 16) \| lowSpeed; // MaxPacketSize == 8
meathome	0:a1f905acca78	648	int r = GetDescriptor(0,DESCRIPTOR_TYPE_DEVICE,0,(u8*)&desc,8);
meathome	0:a1f905acca78	649	if (r < 0)
meathome	0:a1f905acca78	650	{
meathome	0:a1f905acca78	651	LOG("FAILED TO LOAD DESCRIPTOR FOR DEVICE 0\n");
meathome	0:a1f905acca78	652	return r;
meathome	0:a1f905acca78	653	}
meathome	0:a1f905acca78	654
meathome	0:a1f905acca78	655	EndpointZero.EndpointDescriptor.Control = (desc.bMaxPacketSize << 16) \| lowSpeed; // Actual MaxPacketSize
meathome	0:a1f905acca78	656	r = GetDescriptor(0,DESCRIPTOR_TYPE_DEVICE,0,(u8*)&desc,sizeof(desc));
meathome	0:a1f905acca78	657	if (r < 0)
meathome	0:a1f905acca78	658	return r;
meathome	0:a1f905acca78	659
meathome	0:a1f905acca78	660	LOG("\nClass %02X found %04X:%04X\n\n",desc.bDeviceClass,desc.idVendor,desc.idProduct);
meathome	0:a1f905acca78	661
meathome	0:a1f905acca78	662	// Now assign the device an address, move off EndpointZero
meathome	0:a1f905acca78	663	int device = 0;
meathome	0:a1f905acca78	664	for (int i = 0; i < MAX_DEVICES; i++)
meathome	0:a1f905acca78	665	{
meathome	0:a1f905acca78	666	if (Devices[i].Port == 0)
meathome	0:a1f905acca78	667	{
meathome	0:a1f905acca78	668	device = i+1;
meathome	0:a1f905acca78	669	break;
meathome	0:a1f905acca78	670	}
meathome	0:a1f905acca78	671	}
meathome	0:a1f905acca78	672	if (!device)
meathome	0:a1f905acca78	673	return ERR_DEVICE_NONE_LEFT;
meathome	0:a1f905acca78	674
meathome	0:a1f905acca78	675	r = SetAddress(0,device);
meathome	0:a1f905acca78	676	if (r)
meathome	0:a1f905acca78	677	return r;
meathome	0:a1f905acca78	678	DelayMS(2);
meathome	0:a1f905acca78	679
meathome	0:a1f905acca78	680	// Now at a nonzero address, create control endpoint
meathome	0:a1f905acca78	681	Device* dev = &Devices[device-1];
meathome	0:a1f905acca78	682	dev->Init(&desc,hub,port,device,lowSpeed);
meathome	0:a1f905acca78	683	AddEndpoint(device,0,ENDPOINT_CONTROL,desc.bMaxPacketSize,0);
meathome	0:a1f905acca78	684	_connectPending = 0;
meathome	0:a1f905acca78	685
meathome	0:a1f905acca78	686	// Verify this all works
meathome	0:a1f905acca78	687	r = GetDescriptor(device,DESCRIPTOR_TYPE_DEVICE,0,(u8*)&desc,sizeof(desc));
meathome	0:a1f905acca78	688	if (r < 0)
meathome	0:a1f905acca78	689	return r;
meathome	0:a1f905acca78	690
meathome	0:a1f905acca78	691	// Set to interface 0 by default
meathome	0:a1f905acca78	692	// Calls LoadDevice if interface is found
meathome	0:a1f905acca78	693	r = SetConfigurationAndInterface(device,1,0,&desc);
meathome	0:a1f905acca78	694
meathome	0:a1f905acca78	695	if (desc.bDeviceClass == CLASS_HUB)
meathome	0:a1f905acca78	696	InitHub(device); // Handle hubs in this code
meathome	0:a1f905acca78	697
meathome	0:a1f905acca78	698	return device;
meathome	0:a1f905acca78	699	}
meathome	0:a1f905acca78	700
meathome	0:a1f905acca78	701	// Walk descriptors and create endpoints for a given device
meathome	0:a1f905acca78	702	// TODO configuration !=1, alternate settings etc.
meathome	0:a1f905acca78	703	int SetConfigurationAndInterface(int device, int configuration, int interfaceNumber, DeviceDescriptor* desc)
meathome	0:a1f905acca78	704	{
meathome	0:a1f905acca78	705	u8 buffer[255];
meathome	0:a1f905acca78	706	int err = GetDescriptor(device,DESCRIPTOR_TYPE_CONFIGURATION,0,buffer,sizeof(buffer));
meathome	0:a1f905acca78	707	if (err < 0)
meathome	0:a1f905acca78	708	return err;
meathome	0:a1f905acca78	709
meathome	0:a1f905acca78	710	err = SetConfiguration(device,configuration);
meathome	0:a1f905acca78	711	if (err < 0)
meathome	0:a1f905acca78	712	return err;
meathome	0:a1f905acca78	713
meathome	0:a1f905acca78	714	// Add the endpoints for this interface
meathome	0:a1f905acca78	715	int len = buffer[2] \| (buffer[3] << 8);
meathome	0:a1f905acca78	716	u8* d = buffer;
meathome	0:a1f905acca78	717	u8* end = d + len;
meathome	0:a1f905acca78	718	InterfaceDescriptor* found = 0;
meathome	0:a1f905acca78	719	while (d < end)
meathome	0:a1f905acca78	720	{
meathome	0:a1f905acca78	721	if (d[1] == DESCRIPTOR_TYPE_INTERFACE)
meathome	0:a1f905acca78	722	{
meathome	0:a1f905acca78	723	InterfaceDescriptor* id = (InterfaceDescriptor*)d;
meathome	0:a1f905acca78	724	if (id->bInterfaceNumber == interfaceNumber)
meathome	0:a1f905acca78	725	{
meathome	0:a1f905acca78	726	found = id;
meathome	0:a1f905acca78	727	d += d[0];
meathome	0:a1f905acca78	728	while (d < end && d[1] != DESCRIPTOR_TYPE_INTERFACE)
meathome	0:a1f905acca78	729	{
meathome	0:a1f905acca78	730	switch (d[1])
meathome	0:a1f905acca78	731	{
meathome	0:a1f905acca78	732	case DESCRIPTOR_TYPE_ENDPOINT:
meathome	0:a1f905acca78	733	AddEndpoint(device,(EndpointDescriptor*)d);
meathome	0:a1f905acca78	734	break;
meathome	0:a1f905acca78	735	default:
meathome	0:a1f905acca78	736	LOG("Skipping descriptor %02X (%d bytes)\n",d[1],d[0]);
meathome	0:a1f905acca78	737	}
meathome	0:a1f905acca78	738	d += d[0];
meathome	0:a1f905acca78	739	}
meathome	0:a1f905acca78	740	}
meathome	0:a1f905acca78	741	}
meathome	0:a1f905acca78	742	d += d[0];
meathome	0:a1f905acca78	743	}
meathome	0:a1f905acca78	744
meathome	0:a1f905acca78	745	if (!found)
meathome	0:a1f905acca78	746	return ERR_INTERFACE_NOT_FOUND;
meathome	0:a1f905acca78	747	OnLoadDevice(device,desc,found);
meathome	0:a1f905acca78	748	return 0;
meathome	0:a1f905acca78	749	}
meathome	0:a1f905acca78	750
meathome	0:a1f905acca78	751	void Init()
meathome	0:a1f905acca78	752	{
meathome	0:a1f905acca78	753	LOG("USB INIT (Controller is %d bytes)\n",sizeof(*this));
meathome	0:a1f905acca78	754	memset(this,0,sizeof(HostController));
meathome	0:a1f905acca78	755	EndpointZero.CurrentState = Endpoint::NotQueued;
meathome	0:a1f905acca78	756	HWInit(&CommunicationArea);
meathome	0:a1f905acca78	757	DelayMS(10);
meathome	0:a1f905acca78	758	}
meathome	0:a1f905acca78	759
meathome	0:a1f905acca78	760	void ResetPort(int hub, int port)
meathome	0:a1f905acca78	761	{
meathome	0:a1f905acca78	762	LOG("ResetPort Hub:%d Port:%d\n",hub,port);
meathome	0:a1f905acca78	763	_connectPending++; // Only reset/add 1 device at a time
meathome	0:a1f905acca78	764	if (hub == 0)
meathome	0:a1f905acca78	765	LPC_USB->HcRhPortStatus1 = PortResetStatus; // Reset Root Hub, port 1
meathome	0:a1f905acca78	766	else
meathome	0:a1f905acca78	767	SetPortReset(hub,port); // or reset other hub
meathome	0:a1f905acca78	768	}
meathome	0:a1f905acca78	769
meathome	0:a1f905acca78	770	void Disconnect(int hub, int port)
meathome	0:a1f905acca78	771	{
meathome	0:a1f905acca78	772	LOG("Disconnect Hub:%d Port:%d\n",hub,port); // Mark a device for destruction
meathome	0:a1f905acca78	773	for (int i = 0; i < MAX_DEVICES; i++)
meathome	0:a1f905acca78	774	{
meathome	0:a1f905acca78	775	Device* dev = Devices + i;
meathome	0:a1f905acca78	776	if (dev->Port == port && dev->Hub == hub)
meathome	0:a1f905acca78	777	{
meathome	0:a1f905acca78	778	// Disconnect everything that is attached to this device if it is a hub
meathome	0:a1f905acca78	779	for (int p = 0; p < dev->HubPortCount; p++)
meathome	0:a1f905acca78	780	Disconnect(i+1,p+1);
meathome	0:a1f905acca78	781
meathome	0:a1f905acca78	782	// Now release endpoints
meathome	0:a1f905acca78	783	for (int j = 1; j < MAX_ENDPOINTS_PER_DEVICE*2; j += 2)
meathome	0:a1f905acca78	784	{
meathome	0:a1f905acca78	785	u8 endpointIndex = dev->_endpointMap[j];
meathome	0:a1f905acca78	786	if (endpointIndex != 0xFF)
meathome	0:a1f905acca78	787	Release(Endpoints + endpointIndex);
meathome	0:a1f905acca78	788	}
meathome	0:a1f905acca78	789	dev->Port = 0; // Device is now free
meathome	0:a1f905acca78	790	dev->Flags = 0;
meathome	0:a1f905acca78	791	return;
meathome	0:a1f905acca78	792	}
meathome	0:a1f905acca78	793	}
meathome	0:a1f905acca78	794	}
meathome	0:a1f905acca78	795
meathome	0:a1f905acca78	796	// called after reset
meathome	0:a1f905acca78	797	void Connect(int hub, int port, bool lowspeed)
meathome	0:a1f905acca78	798	{
meathome	0:a1f905acca78	799	LOG("Connect Hub:%d Port:%d %s\n",hub,port,lowspeed ? "slow" : "full");
meathome	0:a1f905acca78	800	AddDevice(hub,port,lowspeed);
meathome	0:a1f905acca78	801	}
meathome	0:a1f905acca78	802
meathome	0:a1f905acca78	803	// Called from interrupt
meathome	0:a1f905acca78	804	void HubStatusChange(int hub, int port, u32 status)
meathome	0:a1f905acca78	805	{
meathome	0:a1f905acca78	806	LOG("HubStatusChange Hub:%d Port:%d %08X\n",hub,port,status);
meathome	0:a1f905acca78	807	if (status & ConnectStatusChange)
meathome	0:a1f905acca78	808	{
meathome	0:a1f905acca78	809	if (status & CurrentConnectStatus) // Connecting
meathome	0:a1f905acca78	810	ResetPort(hub,port); // Reset to initiate connect (state machine?)
meathome	0:a1f905acca78	811	else
meathome	0:a1f905acca78	812	Disconnect(hub,port);
meathome	0:a1f905acca78	813	}
meathome	0:a1f905acca78	814
meathome	0:a1f905acca78	815	if (status & PortResetStatusChange)
meathome	0:a1f905acca78	816	{
meathome	0:a1f905acca78	817	if (!(status & PortResetStatus))
meathome	0:a1f905acca78	818	{
meathome	0:a1f905acca78	819	_connectCountdown = 200; // Schedule a connection in 200ms
meathome	0:a1f905acca78	820	if (status & LowspeedDevice)
meathome	0:a1f905acca78	821	port \|= 0x80;
meathome	0:a1f905acca78	822	_connectHub = hub;
meathome	0:a1f905acca78	823	_connectPort = port;
meathome	0:a1f905acca78	824	}
meathome	0:a1f905acca78	825	}
meathome	0:a1f905acca78	826	}
meathome	0:a1f905acca78	827
meathome	0:a1f905acca78	828	#define HOST_CLK_EN (1<<0)
meathome	0:a1f905acca78	829	#define PORTSEL_CLK_EN (1<<3)
meathome	0:a1f905acca78	830	#define AHB_CLK_EN (1<<4)
meathome	0:a1f905acca78	831	#define CLOCK_MASK (HOST_CLK_EN \| PORTSEL_CLK_EN \| AHB_CLK_EN)
meathome	0:a1f905acca78	832
meathome	0:a1f905acca78	833	#define FRAMEINTERVAL (12000-1) // 1ms
meathome	0:a1f905acca78	834	#define DEFAULT_FMINTERVAL ((((6 * (FRAMEINTERVAL - 210)) / 7) << 16) \| FRAMEINTERVAL)
meathome	0:a1f905acca78	835
meathome	0:a1f905acca78	836	void DelayMS(int ms)
meathome	0:a1f905acca78	837	{
meathome	0:a1f905acca78	838	u16 f = ms + CommunicationArea.FrameNumber;
meathome	0:a1f905acca78	839	while (f != CommunicationArea.FrameNumber)
meathome	0:a1f905acca78	840	;
meathome	0:a1f905acca78	841	}
meathome	0:a1f905acca78	842
meathome	0:a1f905acca78	843	static void HWInit(HCCA* cca)
meathome	0:a1f905acca78	844	{
meathome	0:a1f905acca78	845	NVIC_DisableIRQ(USB_IRQn);
meathome	0:a1f905acca78	846
meathome	0:a1f905acca78	847	// turn on power for USB
meathome	0:a1f905acca78	848	LPC_SC->PCONP \|= (1UL<<31);
meathome	0:a1f905acca78	849	// Enable USB host clock, port selection and AHB clock
meathome	0:a1f905acca78	850	LPC_USB->USBClkCtrl \|= CLOCK_MASK;
meathome	0:a1f905acca78	851	// Wait for clocks to become available
meathome	0:a1f905acca78	852	while ((LPC_USB->USBClkSt & CLOCK_MASK) != CLOCK_MASK)
meathome	0:a1f905acca78	853	;
meathome	0:a1f905acca78	854
meathome	0:a1f905acca78	855	// We are a Host
meathome	0:a1f905acca78	856	LPC_USB->OTGStCtrl \|= 1;
meathome	0:a1f905acca78	857	LPC_USB->USBClkCtrl &= ~PORTSEL_CLK_EN; // we don't need port selection clock until we do OTG
meathome	0:a1f905acca78	858
meathome	0:a1f905acca78	859	// configure USB pins
meathome	0:a1f905acca78	860	LPC_PINCON->PINSEL1 &= ~((3<<26)\|(3<<28));
meathome	0:a1f905acca78	861	LPC_PINCON->PINSEL1 \|= ((1<<26)\|(1<<28)); // USB D+/D-
meathome	0:a1f905acca78	862
meathome	0:a1f905acca78	863	LPC_PINCON->PINSEL3 &= ~((3 << 6) \| (3 << 22)); // USB_PPWR, USB_OVRCR
meathome	0:a1f905acca78	864	LPC_PINCON->PINSEL3 \|= ((2 << 6) \| (2 << 22));
meathome	0:a1f905acca78	865
meathome	0:a1f905acca78	866	LPC_PINCON->PINSEL4 &= ~(3 << 18); // USB_CONNECT
meathome	0:a1f905acca78	867	LPC_PINCON->PINSEL4 \|= (1 << 18);
meathome	0:a1f905acca78	868
meathome	0:a1f905acca78	869	// Reset OHCI block
meathome	0:a1f905acca78	870	LPC_USB->HcControl = 0;
meathome	0:a1f905acca78	871	LPC_USB->HcControlHeadED = 0;
meathome	0:a1f905acca78	872	LPC_USB->HcBulkHeadED = 0;
meathome	0:a1f905acca78	873
meathome	0:a1f905acca78	874	LPC_USB->HcCommandStatus = HostControllerReset;
meathome	0:a1f905acca78	875	LPC_USB->HcFmInterval = DEFAULT_FMINTERVAL;
meathome	0:a1f905acca78	876	LPC_USB->HcPeriodicStart = FRAMEINTERVAL*90/100;
meathome	0:a1f905acca78	877
meathome	0:a1f905acca78	878	LPC_USB->HcControl = (LPC_USB->HcControl & (~HostControllerFunctionalState)) \| OperationalMask;
meathome	0:a1f905acca78	879	LPC_USB->HcRhStatus = SetGlobalPower;
meathome	0:a1f905acca78	880
meathome	0:a1f905acca78	881	LPC_USB->HcHCCA = (u32)cca;
meathome	0:a1f905acca78	882	LPC_USB->HcInterruptStatus \|= LPC_USB->HcInterruptStatus;
meathome	0:a1f905acca78	883	LPC_USB->HcInterruptEnable = MasterInterruptEnable \| WritebackDoneHead \| RootHubStatusChange \| FrameNumberOverflow;
meathome	0:a1f905acca78	884
meathome	0:a1f905acca78	885	NVIC_SetPriority(USB_IRQn, 0);
meathome	0:a1f905acca78	886	NVIC_EnableIRQ(USB_IRQn);
meathome	0:a1f905acca78	887	while (cca->FrameNumber < 10)
meathome	0:a1f905acca78	888	; // 10ms delay before diving in
meathome	0:a1f905acca78	889	}
meathome	0:a1f905acca78	890	};
meathome	0:a1f905acca78	891
meathome	0:a1f905acca78	892	//====================================================================================
meathome	0:a1f905acca78	893	//====================================================================================
meathome	0:a1f905acca78	894	// Host controller instance and Interrupt handler
meathome	0:a1f905acca78	895
meathome	0:a1f905acca78	896	static HostController _controller __attribute__((at(USB_RAM_BASE)));
meathome	0:a1f905acca78	897
meathome	0:a1f905acca78	898	extern "C" void USB_IRQHandler(void) __irq;
meathome	0:a1f905acca78	899	void USB_IRQHandler (void) __irq
meathome	0:a1f905acca78	900	{
meathome	0:a1f905acca78	901	u32 int_status = LPC_USB->HcInterruptStatus;
meathome	0:a1f905acca78	902
meathome	0:a1f905acca78	903	if (int_status & RootHubStatusChange) // Root hub status change
meathome	0:a1f905acca78	904	_controller._rootHubStatusChange++; // Just flag the controller, will be processed in USBLoop
meathome	0:a1f905acca78	905
meathome	0:a1f905acca78	906	u32 head = 0;
meathome	0:a1f905acca78	907	if (int_status & WritebackDoneHead)
meathome	0:a1f905acca78	908	{
meathome	0:a1f905acca78	909	head = _controller.CommunicationArea.DoneHead; // Writeback Done
meathome	0:a1f905acca78	910	_controller.CommunicationArea.DoneHead = 0;
meathome	0:a1f905acca78	911	}
meathome	0:a1f905acca78	912	LPC_USB->HcInterruptStatus = int_status;
meathome	0:a1f905acca78	913
meathome	0:a1f905acca78	914	if (head)
meathome	0:a1f905acca78	915	_controller.ProcessDoneQueue(head); // TODO - low bit can be set BUGBUG
meathome	0:a1f905acca78	916	}
meathome	0:a1f905acca78	917
meathome	0:a1f905acca78	918	//====================================================================================
meathome	0:a1f905acca78	919	//====================================================================================
meathome	0:a1f905acca78	920	// API Methods
meathome	0:a1f905acca78	921
meathome	0:a1f905acca78	922	void USBInit()
meathome	0:a1f905acca78	923	{
meathome	0:a1f905acca78	924	return _controller.Init();
meathome	0:a1f905acca78	925	}
meathome	0:a1f905acca78	926
meathome	0:a1f905acca78	927	void USBLoop()
meathome	0:a1f905acca78	928	{
meathome	0:a1f905acca78	929	return _controller.Loop();
meathome	0:a1f905acca78	930	}
meathome	0:a1f905acca78	931
meathome	0:a1f905acca78	932	u8* USBGetBuffer(u32* len)
meathome	0:a1f905acca78	933	{
meathome	0:a1f905acca78	934	*len = USB_RAM_SIZE - sizeof(HostController);
meathome	0:a1f905acca78	935	return _controller.SRAM;
meathome	0:a1f905acca78	936	}
meathome	0:a1f905acca78	937
meathome	0:a1f905acca78	938	static Setup* GetSetup(int device)
meathome	0:a1f905acca78	939	{
meathome	0:a1f905acca78	940	if (device == 0)
meathome	0:a1f905acca78	941	return &_controller._setupZero;
meathome	0:a1f905acca78	942
meathome	0:a1f905acca78	943	if (device < 1 \|\| device > MAX_DEVICES)
meathome	0:a1f905acca78	944	return 0;
meathome	0:a1f905acca78	945	return &_controller.Devices[device-1].SetupBuffer;
meathome	0:a1f905acca78	946	}
meathome	0:a1f905acca78	947
meathome	0:a1f905acca78	948	// Loop until IO on endpoint is complete
meathome	0:a1f905acca78	949	static int WaitIODone(Endpoint* endpoint)
meathome	0:a1f905acca78	950	{
meathome	0:a1f905acca78	951	if (endpoint->CurrentState == Endpoint::NotQueued)
meathome	0:a1f905acca78	952	return 0;
meathome	0:a1f905acca78	953	while (endpoint->CurrentState != Endpoint::Idle)
meathome	0:a1f905acca78	954	USBLoop(); // May generate callbacks, mount or unmount devices etc
meathome	0:a1f905acca78	955	int status = endpoint->Status();
meathome	0:a1f905acca78	956	if (status == 0)
meathome	0:a1f905acca78	957	return endpoint->Length;
meathome	0:a1f905acca78	958	return -status;
meathome	0:a1f905acca78	959	}
meathome	0:a1f905acca78	960
meathome	0:a1f905acca78	961	int USBTransfer(int device, int ep, u8 flags, u8* data, int length, USBCallback callback, void* userData)
meathome	0:a1f905acca78	962	{
meathome	0:a1f905acca78	963	Endpoint* endpoint = _controller.GetEndpoint(device,ep);
meathome	0:a1f905acca78	964	if (!endpoint)
meathome	0:a1f905acca78	965	return ERR_ENDPOINT_NOT_FOUND;
meathome	0:a1f905acca78	966
meathome	0:a1f905acca78	967	WaitIODone(endpoint);
meathome	0:a1f905acca78	968	endpoint->Flags = flags;
meathome	0:a1f905acca78	969	endpoint->Data = data;
meathome	0:a1f905acca78	970	endpoint->Length = length;
meathome	0:a1f905acca78	971	endpoint->Callback = callback;
meathome	0:a1f905acca78	972	endpoint->UserData = userData;
meathome	0:a1f905acca78	973	if (ep == 0)
meathome	0:a1f905acca78	974	_controller.Transfer(endpoint,TOKEN_SETUP,(u8*)GetSetup(device),8,Endpoint::SetupQueued);
meathome	0:a1f905acca78	975	else
meathome	0:a1f905acca78	976	_controller.Transfer(endpoint,flags & 0x80 ? TOKEN_IN : TOKEN_OUT,data,length,Endpoint::DataQueued);
meathome	0:a1f905acca78	977	if (callback)
meathome	0:a1f905acca78	978	return IO_PENDING;
meathome	0:a1f905acca78	979	return WaitIODone(endpoint);
meathome	0:a1f905acca78	980	}
meathome	0:a1f905acca78	981
meathome	0:a1f905acca78	982	int USBControlTransfer(int device, int request_type, int request, int value, int index, u8* data, int length, USBCallback callback, void * userData)
meathome	0:a1f905acca78	983	{
meathome	0:a1f905acca78	984	Setup* setup = GetSetup(device);
meathome	0:a1f905acca78	985	if (!setup)
meathome	0:a1f905acca78	986	return ERR_DEVICE_NOT_FOUND;
meathome	0:a1f905acca78	987
meathome	0:a1f905acca78	988	// Async control calls may overwrite setup buffer of previous call, so we need to wait before setting up next call
meathome	0:a1f905acca78	989	WaitIODone(_controller.GetEndpoint(device,0));
meathome	0:a1f905acca78	990
meathome	0:a1f905acca78	991	setup->bm_request_type = request_type;
meathome	0:a1f905acca78	992	setup->b_request = request;
meathome	0:a1f905acca78	993	setup->w_value = value;
meathome	0:a1f905acca78	994	setup->w_index = index;
meathome	0:a1f905acca78	995	setup->w_length = length;
meathome	0:a1f905acca78	996	return USBTransfer(device,0,request_type & DEVICE_TO_HOST,data,length,callback,userData);
meathome	0:a1f905acca78	997	}
meathome	0:a1f905acca78	998
meathome	0:a1f905acca78	999	int USBInterruptTransfer(int device, int ep, u8* data, int length, USBCallback callback, void* userData)
meathome	0:a1f905acca78	1000	{
meathome	0:a1f905acca78	1001	return USBTransfer(device,ep,(ep & 0x80) \| ENDPOINT_INTERRUPT,data,length,callback,userData);
meathome	0:a1f905acca78	1002	}
meathome	0:a1f905acca78	1003
meathome	0:a1f905acca78	1004	int USBBulkTransfer(int device, int ep, u8* data, int length, USBCallback callback, void* userData)
meathome	0:a1f905acca78	1005	{
meathome	0:a1f905acca78	1006	return USBTransfer(device,ep,(ep & 0x80) \| ENDPOINT_BULK,data,length,callback,userData);
meathome	0:a1f905acca78	1007	}
meathome	0:a1f905acca78	1008
meathome	0:a1f905acca78	1009	int GetDescriptor(int device, int descType,int descIndex, u8* data, int length)
meathome	0:a1f905acca78	1010	{
meathome	0:a1f905acca78	1011	return USBControlTransfer(device,DEVICE_TO_HOST \| RECIPIENT_DEVICE, GET_DESCRIPTOR,(descType << 8)\|(descIndex), 0, data, length, 0);
meathome	0:a1f905acca78	1012	}
meathome	0:a1f905acca78	1013
meathome	0:a1f905acca78	1014	int GetString(int device, int index, char* dst, int length)
meathome	0:a1f905acca78	1015	{
meathome	0:a1f905acca78	1016	u8 buffer[255];
meathome	0:a1f905acca78	1017	int le = GetDescriptor(device,DESCRIPTOR_TYPE_STRING,index,buffer,sizeof(buffer));
meathome	0:a1f905acca78	1018	if (le < 0)
meathome	0:a1f905acca78	1019	return le;
meathome	0:a1f905acca78	1020	if (length < 1)
meathome	0:a1f905acca78	1021	return -1;
meathome	0:a1f905acca78	1022	length <<= 1;
meathome	0:a1f905acca78	1023	if (le > length)
meathome	0:a1f905acca78	1024	le = length;
meathome	0:a1f905acca78	1025	for (int j = 2; j < le; j += 2)
meathome	0:a1f905acca78	1026	*dst++ = buffer[j];
meathome	0:a1f905acca78	1027	*dst = 0;
meathome	0:a1f905acca78	1028	return (le>>1)-1;
meathome	0:a1f905acca78	1029	}
meathome	0:a1f905acca78	1030
meathome	0:a1f905acca78	1031	int SetAddress(int device, int new_addr)
meathome	0:a1f905acca78	1032	{
meathome	0:a1f905acca78	1033	return USBControlTransfer(device,HOST_TO_DEVICE \| RECIPIENT_DEVICE, SET_ADDRESS, new_addr, 0, 0, 0, 0);
meathome	0:a1f905acca78	1034	}
meathome	0:a1f905acca78	1035
meathome	0:a1f905acca78	1036	int SetConfiguration(int device, int configNum)
meathome	0:a1f905acca78	1037	{
meathome	0:a1f905acca78	1038	return USBControlTransfer(device,HOST_TO_DEVICE \| RECIPIENT_DEVICE, SET_CONFIGURATION, configNum, 0, 0, 0, 0);
meathome	0:a1f905acca78	1039	}
meathome	0:a1f905acca78	1040
meathome	0:a1f905acca78	1041	int SetInterface(int device, int ifNum, int altNum)
meathome	0:a1f905acca78	1042	{
meathome	0:a1f905acca78	1043	return USBControlTransfer(device,HOST_TO_DEVICE \| RECIPIENT_INTERFACE, SET_INTERFACE, altNum, ifNum, 0, 0, 0);
meathome	0:a1f905acca78	1044	}
meathome	0:a1f905acca78	1045
meathome	0:a1f905acca78	1046	// HUB stuff
meathome	0:a1f905acca78	1047	int SetPortFeature(int device, int feature, int index)
meathome	0:a1f905acca78	1048	{
meathome	0:a1f905acca78	1049	return USBControlTransfer(device,HOST_TO_DEVICE \| REQUEST_TYPE_CLASS \| RECIPIENT_OTHER,SET_FEATURE,feature,index,0,0);
meathome	0:a1f905acca78	1050	}
meathome	0:a1f905acca78	1051
meathome	0:a1f905acca78	1052	int ClearPortFeature(int device, int feature, int index)
meathome	0:a1f905acca78	1053	{
meathome	0:a1f905acca78	1054	return USBControlTransfer(device,HOST_TO_DEVICE \| REQUEST_TYPE_CLASS \| RECIPIENT_OTHER,CLEAR_FEATURE,feature,index,0,0);
meathome	0:a1f905acca78	1055	}
meathome	0:a1f905acca78	1056
meathome	0:a1f905acca78	1057	int SetPortPower(int device, int port)
meathome	0:a1f905acca78	1058	{
meathome	0:a1f905acca78	1059	int r = SetPortFeature(device,PORT_POWER,port);
meathome	0:a1f905acca78	1060	_controller.DelayMS(20); // 80ms to turn on a hubs power... DESCRIPTOR? todo
meathome	0:a1f905acca78	1061	return r;
meathome	0:a1f905acca78	1062	}
meathome	0:a1f905acca78	1063
meathome	0:a1f905acca78	1064	int SetPortReset(int device, int port)
meathome	0:a1f905acca78	1065	{
meathome	0:a1f905acca78	1066	return SetPortFeature(device,PORT_RESET,port);
meathome	0:a1f905acca78	1067	}
meathome	0:a1f905acca78	1068
meathome	0:a1f905acca78	1069	int GetPortStatus(int device, int port, u32* status)
meathome	0:a1f905acca78	1070	{
meathome	0:a1f905acca78	1071	return USBControlTransfer(device,DEVICE_TO_HOST \| REQUEST_TYPE_CLASS \| RECIPIENT_OTHER,GET_STATUS,0,port,(u8*)status,4);
meathome	0:a1f905acca78	1072	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	01 Mar 2011
Imports:	152
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	1
Followers:	12

USBHost.cpp@0:a1f905acca78, 2011-03-01 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning