Hendrik Vincent / Mbed 2 deprecated Weerstation

Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

NetServices/drv/usb/UsbHostMgr.cpp@0:05ccbd4f84f1, 2013-12-02 (annotated)

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hendrikvincent 0:05ccbd4f84f1 1
hendrikvincent 0:05ccbd4f84f1 2 /*
hendrikvincent 0:05ccbd4f84f1 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
hendrikvincent 0:05ccbd4f84f1 4
hendrikvincent 0:05ccbd4f84f1 5 Permission is hereby granted, free of charge, to any person obtaining a copy
hendrikvincent 0:05ccbd4f84f1 6 of this software and associated documentation files (the "Software"), to deal
hendrikvincent 0:05ccbd4f84f1 7 in the Software without restriction, including without limitation the rights
hendrikvincent 0:05ccbd4f84f1 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
hendrikvincent 0:05ccbd4f84f1 9 copies of the Software, and to permit persons to whom the Software is
hendrikvincent 0:05ccbd4f84f1 10 furnished to do so, subject to the following conditions:
hendrikvincent 0:05ccbd4f84f1 11
hendrikvincent 0:05ccbd4f84f1 12 The above copyright notice and this permission notice shall be included in
hendrikvincent 0:05ccbd4f84f1 13 all copies or substantial portions of the Software.
hendrikvincent 0:05ccbd4f84f1 14
hendrikvincent 0:05ccbd4f84f1 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
hendrikvincent 0:05ccbd4f84f1 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
hendrikvincent 0:05ccbd4f84f1 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
hendrikvincent 0:05ccbd4f84f1 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
hendrikvincent 0:05ccbd4f84f1 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
hendrikvincent 0:05ccbd4f84f1 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
hendrikvincent 0:05ccbd4f84f1 21 THE SOFTWARE.
hendrikvincent 0:05ccbd4f84f1 22 */
hendrikvincent 0:05ccbd4f84f1 23
hendrikvincent 0:05ccbd4f84f1 24 #include "UsbHostMgr.h"
hendrikvincent 0:05ccbd4f84f1 25
hendrikvincent 0:05ccbd4f84f1 26 #include "usb_mem.h"
hendrikvincent 0:05ccbd4f84f1 27
hendrikvincent 0:05ccbd4f84f1 28 #include "string.h" //For memcpy, memmove, memset
hendrikvincent 0:05ccbd4f84f1 29
hendrikvincent 0:05ccbd4f84f1 30 #include "netCfg.h"
hendrikvincent 0:05ccbd4f84f1 31 #if NET_USB
hendrikvincent 0:05ccbd4f84f1 32
hendrikvincent 0:05ccbd4f84f1 33 //#define __DEBUG
hendrikvincent 0:05ccbd4f84f1 34 #include "dbg/dbg.h"
hendrikvincent 0:05ccbd4f84f1 35
hendrikvincent 0:05ccbd4f84f1 36 // bits of the USB/OTG clock control register
hendrikvincent 0:05ccbd4f84f1 37 #define HOST_CLK_EN (1<<0)
hendrikvincent 0:05ccbd4f84f1 38 #define DEV_CLK_EN (1<<1)
hendrikvincent 0:05ccbd4f84f1 39 #define PORTSEL_CLK_EN (1<<3)
hendrikvincent 0:05ccbd4f84f1 40 #define AHB_CLK_EN (1<<4)
hendrikvincent 0:05ccbd4f84f1 41
hendrikvincent 0:05ccbd4f84f1 42 // bits of the USB/OTG clock status register
hendrikvincent 0:05ccbd4f84f1 43 #define HOST_CLK_ON (1<<0)
hendrikvincent 0:05ccbd4f84f1 44 #define DEV_CLK_ON (1<<1)
hendrikvincent 0:05ccbd4f84f1 45 #define PORTSEL_CLK_ON (1<<3)
hendrikvincent 0:05ccbd4f84f1 46 #define AHB_CLK_ON (1<<4)
hendrikvincent 0:05ccbd4f84f1 47
hendrikvincent 0:05ccbd4f84f1 48 // we need host clock, OTG/portsel clock and AHB clock
hendrikvincent 0:05ccbd4f84f1 49 #define CLOCK_MASK (HOST_CLK_EN | PORTSEL_CLK_EN | AHB_CLK_EN)
hendrikvincent 0:05ccbd4f84f1 50
hendrikvincent 0:05ccbd4f84f1 51 static UsbHostMgr* pMgr = NULL;
hendrikvincent 0:05ccbd4f84f1 52
hendrikvincent 0:05ccbd4f84f1 53 extern "C" void sUsbIrqhandler(void) __irq
hendrikvincent 0:05ccbd4f84f1 54 {
hendrikvincent 0:05ccbd4f84f1 55 DBG("\n+Int\n");
hendrikvincent 0:05ccbd4f84f1 56 if(pMgr)
hendrikvincent 0:05ccbd4f84f1 57 pMgr->UsbIrqhandler();
hendrikvincent 0:05ccbd4f84f1 58 DBG("\n-Int\n");
hendrikvincent 0:05ccbd4f84f1 59 return;
hendrikvincent 0:05ccbd4f84f1 60 }
hendrikvincent 0:05ccbd4f84f1 61
hendrikvincent 0:05ccbd4f84f1 62 UsbHostMgr::UsbHostMgr() : m_lpDevices()
hendrikvincent 0:05ccbd4f84f1 63 {
hendrikvincent 0:05ccbd4f84f1 64 /*if(!pMgr)*/ //Assume singleton
hendrikvincent 0:05ccbd4f84f1 65 pMgr = this;
hendrikvincent 0:05ccbd4f84f1 66 usb_mem_init();
hendrikvincent 0:05ccbd4f84f1 67 memset(m_lpDevices, NULL, sizeof(UsbDevice*) * USB_HOSTMGR_MAX_DEVS);
hendrikvincent 0:05ccbd4f84f1 68 m_pHcca = (HCCA*) usb_get_hcca();
hendrikvincent 0:05ccbd4f84f1 69 memset((void*)m_pHcca, 0, 0x100);
hendrikvincent 0:05ccbd4f84f1 70 DBG("Host manager at %p\n", this);
hendrikvincent 0:05ccbd4f84f1 71 }
hendrikvincent 0:05ccbd4f84f1 72
hendrikvincent 0:05ccbd4f84f1 73 UsbHostMgr::~UsbHostMgr()
hendrikvincent 0:05ccbd4f84f1 74 {
hendrikvincent 0:05ccbd4f84f1 75 if(pMgr == this)
hendrikvincent 0:05ccbd4f84f1 76 pMgr = NULL;
hendrikvincent 0:05ccbd4f84f1 77 }
hendrikvincent 0:05ccbd4f84f1 78
hendrikvincent 0:05ccbd4f84f1 79 UsbErr UsbHostMgr::init() //Initialize host
hendrikvincent 0:05ccbd4f84f1 80 {
hendrikvincent 0:05ccbd4f84f1 81 NVIC_DisableIRQ(USB_IRQn); /* Disable the USB interrupt source */
hendrikvincent 0:05ccbd4f84f1 82
hendrikvincent 0:05ccbd4f84f1 83 LPC_SC->PCONP &= ~(1UL<<31); //Cut power
hendrikvincent 0:05ccbd4f84f1 84 wait(1);
hendrikvincent 0:05ccbd4f84f1 85
hendrikvincent 0:05ccbd4f84f1 86
hendrikvincent 0:05ccbd4f84f1 87 // turn on power for USB
hendrikvincent 0:05ccbd4f84f1 88 LPC_SC->PCONP |= (1UL<<31);
hendrikvincent 0:05ccbd4f84f1 89 // Enable USB host clock, port selection and AHB clock
hendrikvincent 0:05ccbd4f84f1 90 LPC_USB->USBClkCtrl |= CLOCK_MASK;
hendrikvincent 0:05ccbd4f84f1 91 // Wait for clocks to become available
hendrikvincent 0:05ccbd4f84f1 92 while ((LPC_USB->USBClkSt & CLOCK_MASK) != CLOCK_MASK)
hendrikvincent 0:05ccbd4f84f1 93 ;
hendrikvincent 0:05ccbd4f84f1 94
hendrikvincent 0:05ccbd4f84f1 95 // it seems the bits[0:1] mean the following
hendrikvincent 0:05ccbd4f84f1 96 // 0: U1=device, U2=host
hendrikvincent 0:05ccbd4f84f1 97 // 1: U1=host, U2=host
hendrikvincent 0:05ccbd4f84f1 98 // 2: reserved
hendrikvincent 0:05ccbd4f84f1 99 // 3: U1=host, U2=device
hendrikvincent 0:05ccbd4f84f1 100 // NB: this register is only available if OTG clock (aka "port select") is enabled!!
hendrikvincent 0:05ccbd4f84f1 101 // since we don't care about port 2, set just bit 0 to 1 (U1=host)
hendrikvincent 0:05ccbd4f84f1 102 LPC_USB->OTGStCtrl |= 1;
hendrikvincent 0:05ccbd4f84f1 103
hendrikvincent 0:05ccbd4f84f1 104 // now that we've configured the ports, we can turn off the portsel clock
hendrikvincent 0:05ccbd4f84f1 105 LPC_USB->USBClkCtrl &= ~PORTSEL_CLK_EN;
hendrikvincent 0:05ccbd4f84f1 106
hendrikvincent 0:05ccbd4f84f1 107 // power pins are not connected on mbed, so we can skip them
hendrikvincent 0:05ccbd4f84f1 108 /* P1[18] = USB_UP_LED, 01 */
hendrikvincent 0:05ccbd4f84f1 109 /* P1[19] = /USB_PPWR, 10 */
hendrikvincent 0:05ccbd4f84f1 110 /* P1[22] = USB_PWRD, 10 */
hendrikvincent 0:05ccbd4f84f1 111 /* P1[27] = /USB_OVRCR, 10 */
hendrikvincent 0:05ccbd4f84f1 112 /*LPC_PINCON->PINSEL3 &= ~((3<<4) | (3<<6) | (3<<12) | (3<<22));
hendrikvincent 0:05ccbd4f84f1 113 LPC_PINCON->PINSEL3 |= ((1<<4)|(2<<6) | (2<<12) | (2<<22)); // 0x00802080
hendrikvincent 0:05ccbd4f84f1 114 */
hendrikvincent 0:05ccbd4f84f1 115
hendrikvincent 0:05ccbd4f84f1 116 // configure USB D+/D- pins
hendrikvincent 0:05ccbd4f84f1 117 /* P0[29] = USB_D+, 01 */
hendrikvincent 0:05ccbd4f84f1 118 /* P0[30] = USB_D-, 01 */
hendrikvincent 0:05ccbd4f84f1 119 LPC_PINCON->PINSEL1 &= ~((3<<26) | (3<<28));
hendrikvincent 0:05ccbd4f84f1 120 LPC_PINCON->PINSEL1 |= ((1<<26)|(1<<28)); // 0x14000000
hendrikvincent 0:05ccbd4f84f1 121
hendrikvincent 0:05ccbd4f84f1 122 DBG("Initializing Host Stack\n");
hendrikvincent 0:05ccbd4f84f1 123
hendrikvincent 0:05ccbd4f84f1 124 wait_ms(100); /* Wait 50 ms before apply reset */
hendrikvincent 0:05ccbd4f84f1 125 LPC_USB->HcControl = 0; /* HARDWARE RESET */
hendrikvincent 0:05ccbd4f84f1 126 LPC_USB->HcControlHeadED = 0; /* Initialize Control list head to Zero */
hendrikvincent 0:05ccbd4f84f1 127 LPC_USB->HcBulkHeadED = 0; /* Initialize Bulk list head to Zero */
hendrikvincent 0:05ccbd4f84f1 128
hendrikvincent 0:05ccbd4f84f1 129 /* SOFTWARE RESET */
hendrikvincent 0:05ccbd4f84f1 130 LPC_USB->HcCommandStatus = OR_CMD_STATUS_HCR;
hendrikvincent 0:05ccbd4f84f1 131 LPC_USB->HcFmInterval = DEFAULT_FMINTERVAL; /* Write Fm Interval and Largest Data Packet Counter */
hendrikvincent 0:05ccbd4f84f1 132
hendrikvincent 0:05ccbd4f84f1 133 /* Put HC in operational state */
hendrikvincent 0:05ccbd4f84f1 134 LPC_USB->HcControl = (LPC_USB->HcControl & (~OR_CONTROL_HCFS)) | OR_CONTROL_HC_OPER;
hendrikvincent 0:05ccbd4f84f1 135 LPC_USB->HcRhStatus = OR_RH_STATUS_LPSC; /* Set Global Power */
hendrikvincent 0:05ccbd4f84f1 136
hendrikvincent 0:05ccbd4f84f1 137 LPC_USB->HcHCCA = (uint32_t)(m_pHcca);
hendrikvincent 0:05ccbd4f84f1 138 LPC_USB->HcInterruptStatus |= LPC_USB->HcInterruptStatus; /* Clear Interrrupt Status */
hendrikvincent 0:05ccbd4f84f1 139
hendrikvincent 0:05ccbd4f84f1 140
hendrikvincent 0:05ccbd4f84f1 141 LPC_USB->HcInterruptEnable = OR_INTR_ENABLE_MIE |
hendrikvincent 0:05ccbd4f84f1 142 OR_INTR_ENABLE_WDH |
hendrikvincent 0:05ccbd4f84f1 143 OR_INTR_ENABLE_RHSC;
hendrikvincent 0:05ccbd4f84f1 144
hendrikvincent 0:05ccbd4f84f1 145 NVIC_SetPriority(USB_IRQn, 0); /* highest priority */
hendrikvincent 0:05ccbd4f84f1 146 /* Enable the USB Interrupt */
hendrikvincent 0:05ccbd4f84f1 147 NVIC_SetVector(USB_IRQn, (uint32_t)(sUsbIrqhandler));
hendrikvincent 0:05ccbd4f84f1 148 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_CSC;
hendrikvincent 0:05ccbd4f84f1 149 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC;
hendrikvincent 0:05ccbd4f84f1 150
hendrikvincent 0:05ccbd4f84f1 151 /* Check for any connected devices */
hendrikvincent 0:05ccbd4f84f1 152 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CCS) //Root device connected
hendrikvincent 0:05ccbd4f84f1 153 {
hendrikvincent 0:05ccbd4f84f1 154 //Device connected
hendrikvincent 0:05ccbd4f84f1 155 wait(1);
hendrikvincent 0:05ccbd4f84f1 156 DBG("Device connected (%08x)\n", LPC_USB->HcRhPortStatus1);
hendrikvincent 0:05ccbd4f84f1 157 onUsbDeviceConnected(0, 1); //Hub 0 (root hub), Port 1 (count starts at 1)
hendrikvincent 0:05ccbd4f84f1 158 }
hendrikvincent 0:05ccbd4f84f1 159
hendrikvincent 0:05ccbd4f84f1 160 DBG("Enabling IRQ\n");
hendrikvincent 0:05ccbd4f84f1 161 NVIC_EnableIRQ(USB_IRQn);
hendrikvincent 0:05ccbd4f84f1 162 DBG("End of host stack initialization\n");
hendrikvincent 0:05ccbd4f84f1 163 return USBERR_OK;
hendrikvincent 0:05ccbd4f84f1 164 }
hendrikvincent 0:05ccbd4f84f1 165
hendrikvincent 0:05ccbd4f84f1 166 void UsbHostMgr::poll() //Enumerate connected devices, etc
hendrikvincent 0:05ccbd4f84f1 167 {
hendrikvincent 0:05ccbd4f84f1 168 /* Check for any connected devices */
hendrikvincent 0:05ccbd4f84f1 169 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CCS) //Root device connected
hendrikvincent 0:05ccbd4f84f1 170 {
hendrikvincent 0:05ccbd4f84f1 171 //Device connected
hendrikvincent 0:05ccbd4f84f1 172 wait(1);
hendrikvincent 0:05ccbd4f84f1 173 DBG("Device connected (%08x)\n", LPC_USB->HcRhPortStatus1);
hendrikvincent 0:05ccbd4f84f1 174 onUsbDeviceConnected(0, 1); //Hub 0 (root hub), Port 1 (count starts at 1)
hendrikvincent 0:05ccbd4f84f1 175 }
hendrikvincent 0:05ccbd4f84f1 176
hendrikvincent 0:05ccbd4f84f1 177 for(int i = 0; i < devicesCount(); i++)
hendrikvincent 0:05ccbd4f84f1 178 {
hendrikvincent 0:05ccbd4f84f1 179 if( (m_lpDevices[i]->m_connected)
hendrikvincent 0:05ccbd4f84f1 180 && !(m_lpDevices[i]->m_enumerated) )
hendrikvincent 0:05ccbd4f84f1 181 {
hendrikvincent 0:05ccbd4f84f1 182 m_lpDevices[i]->enumerate();
hendrikvincent 0:05ccbd4f84f1 183 return;
hendrikvincent 0:05ccbd4f84f1 184 }
hendrikvincent 0:05ccbd4f84f1 185 }
hendrikvincent 0:05ccbd4f84f1 186 }
hendrikvincent 0:05ccbd4f84f1 187
hendrikvincent 0:05ccbd4f84f1 188 int UsbHostMgr::devicesCount()
hendrikvincent 0:05ccbd4f84f1 189 {
hendrikvincent 0:05ccbd4f84f1 190 int i;
hendrikvincent 0:05ccbd4f84f1 191 for(i = 0; i < USB_HOSTMGR_MAX_DEVS; i++)
hendrikvincent 0:05ccbd4f84f1 192 {
hendrikvincent 0:05ccbd4f84f1 193 if (m_lpDevices[i] == NULL)
hendrikvincent 0:05ccbd4f84f1 194 break;
hendrikvincent 0:05ccbd4f84f1 195 }
hendrikvincent 0:05ccbd4f84f1 196 return i;
hendrikvincent 0:05ccbd4f84f1 197 }
hendrikvincent 0:05ccbd4f84f1 198
hendrikvincent 0:05ccbd4f84f1 199 UsbDevice* UsbHostMgr::getDevice(int item)
hendrikvincent 0:05ccbd4f84f1 200 {
hendrikvincent 0:05ccbd4f84f1 201 UsbDevice* pDev = m_lpDevices[item];
hendrikvincent 0:05ccbd4f84f1 202 if(!pDev)
hendrikvincent 0:05ccbd4f84f1 203 return NULL;
hendrikvincent 0:05ccbd4f84f1 204
hendrikvincent 0:05ccbd4f84f1 205 pDev->m_refs++;
hendrikvincent 0:05ccbd4f84f1 206 return pDev;
hendrikvincent 0:05ccbd4f84f1 207 }
hendrikvincent 0:05ccbd4f84f1 208
hendrikvincent 0:05ccbd4f84f1 209 void UsbHostMgr::releaseDevice(UsbDevice* pDev)
hendrikvincent 0:05ccbd4f84f1 210 {
hendrikvincent 0:05ccbd4f84f1 211 pDev->m_refs--;
hendrikvincent 0:05ccbd4f84f1 212 if(pDev->m_refs > 0)
hendrikvincent 0:05ccbd4f84f1 213 return;
hendrikvincent 0:05ccbd4f84f1 214 //If refs count = 0, delete
hendrikvincent 0:05ccbd4f84f1 215 //Find & remove from list
hendrikvincent 0:05ccbd4f84f1 216 int i;
hendrikvincent 0:05ccbd4f84f1 217 for(i = 0; i < USB_HOSTMGR_MAX_DEVS; i++)
hendrikvincent 0:05ccbd4f84f1 218 {
hendrikvincent 0:05ccbd4f84f1 219 if (m_lpDevices[i] == pDev)
hendrikvincent 0:05ccbd4f84f1 220 break;
hendrikvincent 0:05ccbd4f84f1 221 }
hendrikvincent 0:05ccbd4f84f1 222 if(i!=USB_HOSTMGR_MAX_DEVS)
hendrikvincent 0:05ccbd4f84f1 223 memmove(&m_lpDevices[i], &m_lpDevices[i+1], sizeof(UsbDevice*) * (USB_HOSTMGR_MAX_DEVS - (i + 1))); //Safer than memcpy because of overlapping mem
hendrikvincent 0:05ccbd4f84f1 224 m_lpDevices[USB_HOSTMGR_MAX_DEVS - 1] = NULL;
hendrikvincent 0:05ccbd4f84f1 225 delete pDev;
hendrikvincent 0:05ccbd4f84f1 226 }
hendrikvincent 0:05ccbd4f84f1 227
hendrikvincent 0:05ccbd4f84f1 228 void UsbHostMgr::UsbIrqhandler()
hendrikvincent 0:05ccbd4f84f1 229 {
hendrikvincent 0:05ccbd4f84f1 230 uint32_t int_status;
hendrikvincent 0:05ccbd4f84f1 231 uint32_t ie_status;
hendrikvincent 0:05ccbd4f84f1 232
hendrikvincent 0:05ccbd4f84f1 233 int_status = LPC_USB->HcInterruptStatus; /* Read Interrupt Status */
hendrikvincent 0:05ccbd4f84f1 234 ie_status = LPC_USB->HcInterruptEnable; /* Read Interrupt enable status */
hendrikvincent 0:05ccbd4f84f1 235
hendrikvincent 0:05ccbd4f84f1 236 if (!(int_status & ie_status))
hendrikvincent 0:05ccbd4f84f1 237 {
hendrikvincent 0:05ccbd4f84f1 238 return;
hendrikvincent 0:05ccbd4f84f1 239 }
hendrikvincent 0:05ccbd4f84f1 240 else
hendrikvincent 0:05ccbd4f84f1 241 {
hendrikvincent 0:05ccbd4f84f1 242 int_status = int_status & ie_status;
hendrikvincent 0:05ccbd4f84f1 243 if (int_status & OR_INTR_STATUS_RHSC) /* Root hub status change interrupt */
hendrikvincent 0:05ccbd4f84f1 244 {
hendrikvincent 0:05ccbd4f84f1 245 DBG("LPC_USB->HcRhPortStatus1 = %08x\n", LPC_USB->HcRhPortStatus1);
hendrikvincent 0:05ccbd4f84f1 246 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CSC)
hendrikvincent 0:05ccbd4f84f1 247 {
hendrikvincent 0:05ccbd4f84f1 248 if (LPC_USB->HcRhStatus & OR_RH_STATUS_DRWE)
hendrikvincent 0:05ccbd4f84f1 249 {
hendrikvincent 0:05ccbd4f84f1 250 /*
hendrikvincent 0:05ccbd4f84f1 251 * When DRWE is on, Connect Status Change
hendrikvincent 0:05ccbd4f84f1 252 * means a remote wakeup event.
hendrikvincent 0:05ccbd4f84f1 253 */
hendrikvincent 0:05ccbd4f84f1 254 //HOST_RhscIntr = 1;// JUST SOMETHING FOR A BREAKPOINT
hendrikvincent 0:05ccbd4f84f1 255 }
hendrikvincent 0:05ccbd4f84f1 256 else
hendrikvincent 0:05ccbd4f84f1 257 {
hendrikvincent 0:05ccbd4f84f1 258 /*
hendrikvincent 0:05ccbd4f84f1 259 * When DRWE is off, Connect Status Change
hendrikvincent 0:05ccbd4f84f1 260 * is NOT a remote wakeup event
hendrikvincent 0:05ccbd4f84f1 261 */
hendrikvincent 0:05ccbd4f84f1 262 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CCS) //Root device connected
hendrikvincent 0:05ccbd4f84f1 263 {
hendrikvincent 0:05ccbd4f84f1 264 //Device connected
hendrikvincent 0:05ccbd4f84f1 265 DBG("Device connected (%08x)\n", LPC_USB->HcRhPortStatus1);
hendrikvincent 0:05ccbd4f84f1 266 onUsbDeviceConnected(0, 1); //Hub 0 (root hub), Port 1 (count starts at 1)
hendrikvincent 0:05ccbd4f84f1 267 }
hendrikvincent 0:05ccbd4f84f1 268 else //Root device disconnected
hendrikvincent 0:05ccbd4f84f1 269 {
hendrikvincent 0:05ccbd4f84f1 270 //Device disconnected
hendrikvincent 0:05ccbd4f84f1 271 DBG("Device disconnected\n");
hendrikvincent 0:05ccbd4f84f1 272 onUsbDeviceDisconnected(0, 1);
hendrikvincent 0:05ccbd4f84f1 273 }
hendrikvincent 0:05ccbd4f84f1 274 //TODO: HUBS
hendrikvincent 0:05ccbd4f84f1 275 }
hendrikvincent 0:05ccbd4f84f1 276 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_CSC;
hendrikvincent 0:05ccbd4f84f1 277 }
hendrikvincent 0:05ccbd4f84f1 278 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_PRSC)
hendrikvincent 0:05ccbd4f84f1 279 {
hendrikvincent 0:05ccbd4f84f1 280 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC;
hendrikvincent 0:05ccbd4f84f1 281 }
hendrikvincent 0:05ccbd4f84f1 282 }
hendrikvincent 0:05ccbd4f84f1 283 if (int_status & OR_INTR_STATUS_WDH) /* Writeback Done Head interrupt */
hendrikvincent 0:05ccbd4f84f1 284 {
hendrikvincent 0:05ccbd4f84f1 285 //UsbEndpoint::sOnCompletion((LPC_USB->HccaDoneHead) & 0xFE);
hendrikvincent 0:05ccbd4f84f1 286 if(m_pHcca->DoneHead)
hendrikvincent 0:05ccbd4f84f1 287 {
hendrikvincent 0:05ccbd4f84f1 288 UsbEndpoint::sOnCompletion(m_pHcca->DoneHead);
hendrikvincent 0:05ccbd4f84f1 289 m_pHcca->DoneHead = 0;
hendrikvincent 0:05ccbd4f84f1 290 LPC_USB->HcInterruptStatus = OR_INTR_STATUS_WDH;
hendrikvincent 0:05ccbd4f84f1 291 if(m_pHcca->DoneHead)
hendrikvincent 0:05ccbd4f84f1 292 DBG("??????????????????????????????\n\n\n");
hendrikvincent 0:05ccbd4f84f1 293 }
hendrikvincent 0:05ccbd4f84f1 294 else
hendrikvincent 0:05ccbd4f84f1 295 {
hendrikvincent 0:05ccbd4f84f1 296 //Probably an error
hendrikvincent 0:05ccbd4f84f1 297 int_status = LPC_USB->HcInterruptStatus;
hendrikvincent 0:05ccbd4f84f1 298 DBG("HcInterruptStatus = %08x\n", int_status);
hendrikvincent 0:05ccbd4f84f1 299 if (int_status & OR_INTR_STATUS_UE) //Unrecoverable error, disconnect devices and resume
hendrikvincent 0:05ccbd4f84f1 300 {
hendrikvincent 0:05ccbd4f84f1 301 onUsbDeviceDisconnected(0, 1);
hendrikvincent 0:05ccbd4f84f1 302 LPC_USB->HcInterruptStatus = OR_INTR_STATUS_UE;
hendrikvincent 0:05ccbd4f84f1 303 LPC_USB->HcCommandStatus = 0x01; //Host Controller Reset
hendrikvincent 0:05ccbd4f84f1 304 }
hendrikvincent 0:05ccbd4f84f1 305 }
hendrikvincent 0:05ccbd4f84f1 306 }
hendrikvincent 0:05ccbd4f84f1 307 LPC_USB->HcInterruptStatus = int_status; /* Clear interrupt status register */
hendrikvincent 0:05ccbd4f84f1 308 }
hendrikvincent 0:05ccbd4f84f1 309 return;
hendrikvincent 0:05ccbd4f84f1 310 }
hendrikvincent 0:05ccbd4f84f1 311
hendrikvincent 0:05ccbd4f84f1 312 void UsbHostMgr::onUsbDeviceConnected(int hub, int port)
hendrikvincent 0:05ccbd4f84f1 313 {
hendrikvincent 0:05ccbd4f84f1 314 int item = devicesCount();
hendrikvincent 0:05ccbd4f84f1 315 if( item == USB_HOSTMGR_MAX_DEVS )
hendrikvincent 0:05ccbd4f84f1 316 return; //List full...
hendrikvincent 0:05ccbd4f84f1 317 //Find a free address (not optimized, but not really important)
hendrikvincent 0:05ccbd4f84f1 318 int i;
hendrikvincent 0:05ccbd4f84f1 319 int addr = 1;
hendrikvincent 0:05ccbd4f84f1 320 for(i = 0; i < item; i++)
hendrikvincent 0:05ccbd4f84f1 321 {
hendrikvincent 0:05ccbd4f84f1 322 addr = MAX( addr, m_lpDevices[i]->m_addr + 1 );
hendrikvincent 0:05ccbd4f84f1 323 }
hendrikvincent 0:05ccbd4f84f1 324 m_lpDevices[item] = new UsbDevice( this, hub, port, addr );
hendrikvincent 0:05ccbd4f84f1 325 m_lpDevices[item]->m_connected = true;
hendrikvincent 0:05ccbd4f84f1 326 }
hendrikvincent 0:05ccbd4f84f1 327
hendrikvincent 0:05ccbd4f84f1 328 void UsbHostMgr::onUsbDeviceDisconnected(int hub, int port)
hendrikvincent 0:05ccbd4f84f1 329 {
hendrikvincent 0:05ccbd4f84f1 330 for(int i = 0; i < devicesCount(); i++)
hendrikvincent 0:05ccbd4f84f1 331 {
hendrikvincent 0:05ccbd4f84f1 332 if( (m_lpDevices[i]->m_hub == hub)
hendrikvincent 0:05ccbd4f84f1 333 && (m_lpDevices[i]->m_port == port) )
hendrikvincent 0:05ccbd4f84f1 334 {
hendrikvincent 0:05ccbd4f84f1 335 m_lpDevices[i]->m_connected = false;
hendrikvincent 0:05ccbd4f84f1 336 if(!m_lpDevices[i]->m_enumerated)
hendrikvincent 0:05ccbd4f84f1 337 {
hendrikvincent 0:05ccbd4f84f1 338 delete m_lpDevices[i];
hendrikvincent 0:05ccbd4f84f1 339 m_lpDevices[i] = NULL;
hendrikvincent 0:05ccbd4f84f1 340 }
hendrikvincent 0:05ccbd4f84f1 341 return;
hendrikvincent 0:05ccbd4f84f1 342 }
hendrikvincent 0:05ccbd4f84f1 343 }
hendrikvincent 0:05ccbd4f84f1 344 }
hendrikvincent 0:05ccbd4f84f1 345
hendrikvincent 0:05ccbd4f84f1 346 void UsbHostMgr::resetPort(int hub, int port)
hendrikvincent 0:05ccbd4f84f1 347 {
hendrikvincent 0:05ccbd4f84f1 348 DBG("Resetting hub %d, port %d\n", hub, port);
hendrikvincent 0:05ccbd4f84f1 349 if(hub == 0) //Root hub
hendrikvincent 0:05ccbd4f84f1 350 {
hendrikvincent 0:05ccbd4f84f1 351 wait_ms(100); /* USB 2.0 spec says at least 50ms delay before port reset */
hendrikvincent 0:05ccbd4f84f1 352 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRS; // Initiate port reset
hendrikvincent 0:05ccbd4f84f1 353 DBG("Before loop\n");
hendrikvincent 0:05ccbd4f84f1 354 while (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_PRS)
hendrikvincent 0:05ccbd4f84f1 355 ;
hendrikvincent 0:05ccbd4f84f1 356 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC; // ...and clear port reset signal
hendrikvincent 0:05ccbd4f84f1 357 DBG("After loop\n");
hendrikvincent 0:05ccbd4f84f1 358 wait_ms(200); /* Wait for 100 MS after port reset */
hendrikvincent 0:05ccbd4f84f1 359 }
hendrikvincent 0:05ccbd4f84f1 360 else
hendrikvincent 0:05ccbd4f84f1 361 {
hendrikvincent 0:05ccbd4f84f1 362 //TODO: Hubs
hendrikvincent 0:05ccbd4f84f1 363 }
hendrikvincent 0:05ccbd4f84f1 364 DBG("Port reset OK\n");
hendrikvincent 0:05ccbd4f84f1 365 }
hendrikvincent 0:05ccbd4f84f1 366
hendrikvincent 0:05ccbd4f84f1 367 #endif