Dependencies:   mbed

Committer:
slowness
Date:
Sun Aug 28 16:16:43 2011 +0000
Revision:
0:2063c10a1022

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
slowness 0:2063c10a1022 1 /*
slowness 0:2063c10a1022 2 **************************************************************************************************************
slowness 0:2063c10a1022 3 * NXP USB Host Stack
slowness 0:2063c10a1022 4 *
slowness 0:2063c10a1022 5 * (c) Copyright 2008, NXP SemiConductors
slowness 0:2063c10a1022 6 * (c) Copyright 2008, OnChip Technologies LLC
slowness 0:2063c10a1022 7 * All Rights Reserved
slowness 0:2063c10a1022 8 *
slowness 0:2063c10a1022 9 * www.nxp.com
slowness 0:2063c10a1022 10 * www.onchiptech.com
slowness 0:2063c10a1022 11 *
slowness 0:2063c10a1022 12 * File : usbhost_lpc17xx.c
slowness 0:2063c10a1022 13 * Programmer(s) : Ravikanth.P
slowness 0:2063c10a1022 14 * Version :
slowness 0:2063c10a1022 15 *
slowness 0:2063c10a1022 16 **************************************************************************************************************
slowness 0:2063c10a1022 17 */
slowness 0:2063c10a1022 18
slowness 0:2063c10a1022 19 /*
slowness 0:2063c10a1022 20 **************************************************************************************************************
slowness 0:2063c10a1022 21 * INCLUDE HEADER FILES
slowness 0:2063c10a1022 22 **************************************************************************************************************
slowness 0:2063c10a1022 23 */
slowness 0:2063c10a1022 24
slowness 0:2063c10a1022 25 #include "usbhost_lpc17xx.h"
slowness 0:2063c10a1022 26
slowness 0:2063c10a1022 27 /*
slowness 0:2063c10a1022 28 **************************************************************************************************************
slowness 0:2063c10a1022 29 * GLOBAL VARIABLES
slowness 0:2063c10a1022 30 **************************************************************************************************************
slowness 0:2063c10a1022 31 */
slowness 0:2063c10a1022 32 int gUSBConnected;
slowness 0:2063c10a1022 33
slowness 0:2063c10a1022 34 volatile USB_INT32U HOST_RhscIntr = 0; /* Root Hub Status Change interrupt */
slowness 0:2063c10a1022 35 volatile USB_INT32U HOST_WdhIntr = 0; /* Semaphore to wait until the TD is submitted */
slowness 0:2063c10a1022 36 volatile USB_INT08U HOST_TDControlStatus = 0;
slowness 0:2063c10a1022 37 volatile HCED *EDCtrl; /* Control endpoint descriptor structure */
slowness 0:2063c10a1022 38 volatile HCED *EDBulkIn; /* BulkIn endpoint descriptor structure */
slowness 0:2063c10a1022 39 volatile HCED *EDBulkOut; /* BulkOut endpoint descriptor structure */
slowness 0:2063c10a1022 40 volatile HCTD *TDHead; /* Head transfer descriptor structure */
slowness 0:2063c10a1022 41 volatile HCTD *TDTail; /* Tail transfer descriptor structure */
slowness 0:2063c10a1022 42 volatile HCCA *Hcca; /* Host Controller Communications Area structure */
slowness 0:2063c10a1022 43 USB_INT16U *TDBufNonVol; /* Identical to TDBuffer just to reduce compiler warnings */
slowness 0:2063c10a1022 44 volatile USB_INT08U *TDBuffer; /* Current Buffer Pointer of transfer descriptor */
slowness 0:2063c10a1022 45
slowness 0:2063c10a1022 46 // USB host structures
slowness 0:2063c10a1022 47 // AHB SRAM block 1
slowness 0:2063c10a1022 48 #define HOSTBASEADDR 0x2007C000
slowness 0:2063c10a1022 49 // reserve memory for the linker
slowness 0:2063c10a1022 50 static USB_INT08U HostBuf[0x200] __attribute__((at(HOSTBASEADDR)));
slowness 0:2063c10a1022 51 /*
slowness 0:2063c10a1022 52 **************************************************************************************************************
slowness 0:2063c10a1022 53 * DELAY IN MILLI SECONDS
slowness 0:2063c10a1022 54 *
slowness 0:2063c10a1022 55 * Description: This function provides a delay in milli seconds
slowness 0:2063c10a1022 56 *
slowness 0:2063c10a1022 57 * Arguments : delay The delay required
slowness 0:2063c10a1022 58 *
slowness 0:2063c10a1022 59 * Returns : None
slowness 0:2063c10a1022 60 *
slowness 0:2063c10a1022 61 **************************************************************************************************************
slowness 0:2063c10a1022 62 */
slowness 0:2063c10a1022 63
slowness 0:2063c10a1022 64 void Host_DelayMS (USB_INT32U delay)
slowness 0:2063c10a1022 65 {
slowness 0:2063c10a1022 66 volatile USB_INT32U i;
slowness 0:2063c10a1022 67
slowness 0:2063c10a1022 68
slowness 0:2063c10a1022 69 for (i = 0; i < delay; i++) {
slowness 0:2063c10a1022 70 Host_DelayUS(1000);
slowness 0:2063c10a1022 71 }
slowness 0:2063c10a1022 72 }
slowness 0:2063c10a1022 73
slowness 0:2063c10a1022 74 /*
slowness 0:2063c10a1022 75 **************************************************************************************************************
slowness 0:2063c10a1022 76 * DELAY IN MICRO SECONDS
slowness 0:2063c10a1022 77 *
slowness 0:2063c10a1022 78 * Description: This function provides a delay in micro seconds
slowness 0:2063c10a1022 79 *
slowness 0:2063c10a1022 80 * Arguments : delay The delay required
slowness 0:2063c10a1022 81 *
slowness 0:2063c10a1022 82 * Returns : None
slowness 0:2063c10a1022 83 *
slowness 0:2063c10a1022 84 **************************************************************************************************************
slowness 0:2063c10a1022 85 */
slowness 0:2063c10a1022 86
slowness 0:2063c10a1022 87 void Host_DelayUS (USB_INT32U delay)
slowness 0:2063c10a1022 88 {
slowness 0:2063c10a1022 89 volatile USB_INT32U i;
slowness 0:2063c10a1022 90
slowness 0:2063c10a1022 91
slowness 0:2063c10a1022 92 for (i = 0; i < (4 * delay); i++) { /* This logic was tested. It gives app. 1 micro sec delay */
slowness 0:2063c10a1022 93 ;
slowness 0:2063c10a1022 94 }
slowness 0:2063c10a1022 95 }
slowness 0:2063c10a1022 96
slowness 0:2063c10a1022 97 // bits of the USB/OTG clock control register
slowness 0:2063c10a1022 98 #define HOST_CLK_EN (1<<0)
slowness 0:2063c10a1022 99 #define DEV_CLK_EN (1<<1)
slowness 0:2063c10a1022 100 #define PORTSEL_CLK_EN (1<<3)
slowness 0:2063c10a1022 101 #define AHB_CLK_EN (1<<4)
slowness 0:2063c10a1022 102
slowness 0:2063c10a1022 103 // bits of the USB/OTG clock status register
slowness 0:2063c10a1022 104 #define HOST_CLK_ON (1<<0)
slowness 0:2063c10a1022 105 #define DEV_CLK_ON (1<<1)
slowness 0:2063c10a1022 106 #define PORTSEL_CLK_ON (1<<3)
slowness 0:2063c10a1022 107 #define AHB_CLK_ON (1<<4)
slowness 0:2063c10a1022 108
slowness 0:2063c10a1022 109 // we need host clock, OTG/portsel clock and AHB clock
slowness 0:2063c10a1022 110 #define CLOCK_MASK (HOST_CLK_EN | PORTSEL_CLK_EN | AHB_CLK_EN)
slowness 0:2063c10a1022 111
slowness 0:2063c10a1022 112 /*
slowness 0:2063c10a1022 113 **************************************************************************************************************
slowness 0:2063c10a1022 114 * INITIALIZE THE HOST CONTROLLER
slowness 0:2063c10a1022 115 *
slowness 0:2063c10a1022 116 * Description: This function initializes lpc17xx host controller
slowness 0:2063c10a1022 117 *
slowness 0:2063c10a1022 118 * Arguments : None
slowness 0:2063c10a1022 119 *
slowness 0:2063c10a1022 120 * Returns :
slowness 0:2063c10a1022 121 *
slowness 0:2063c10a1022 122 **************************************************************************************************************
slowness 0:2063c10a1022 123 */
slowness 0:2063c10a1022 124 void Host_Init (void)
slowness 0:2063c10a1022 125 {
slowness 0:2063c10a1022 126 PRINT_Log("In Host_Init\n");
slowness 0:2063c10a1022 127 NVIC_DisableIRQ(USB_IRQn); /* Disable the USB interrupt source */
slowness 0:2063c10a1022 128
slowness 0:2063c10a1022 129 // turn on power for USB
slowness 0:2063c10a1022 130 LPC_SC->PCONP |= (1UL<<31);
slowness 0:2063c10a1022 131 // Enable USB host clock, port selection and AHB clock
slowness 0:2063c10a1022 132 LPC_USB->USBClkCtrl |= CLOCK_MASK;
slowness 0:2063c10a1022 133 // Wait for clocks to become available
slowness 0:2063c10a1022 134 while ((LPC_USB->USBClkSt & CLOCK_MASK) != CLOCK_MASK)
slowness 0:2063c10a1022 135 ;
slowness 0:2063c10a1022 136
slowness 0:2063c10a1022 137 // it seems the bits[0:1] mean the following
slowness 0:2063c10a1022 138 // 0: U1=device, U2=host
slowness 0:2063c10a1022 139 // 1: U1=host, U2=host
slowness 0:2063c10a1022 140 // 2: reserved
slowness 0:2063c10a1022 141 // 3: U1=host, U2=device
slowness 0:2063c10a1022 142 // NB: this register is only available if OTG clock (aka "port select") is enabled!!
slowness 0:2063c10a1022 143 // since we don't care about port 2, set just bit 0 to 1 (U1=host)
slowness 0:2063c10a1022 144 LPC_USB->OTGStCtrl |= 1;
slowness 0:2063c10a1022 145
slowness 0:2063c10a1022 146 // now that we've configured the ports, we can turn off the portsel clock
slowness 0:2063c10a1022 147 LPC_USB->USBClkCtrl &= ~PORTSEL_CLK_EN;
slowness 0:2063c10a1022 148
slowness 0:2063c10a1022 149 // power pins are not connected on mbed, so we can skip them
slowness 0:2063c10a1022 150 /* P1[18] = USB_UP_LED, 01 */
slowness 0:2063c10a1022 151 /* P1[19] = /USB_PPWR, 10 */
slowness 0:2063c10a1022 152 /* P1[22] = USB_PWRD, 10 */
slowness 0:2063c10a1022 153 /* P1[27] = /USB_OVRCR, 10 */
slowness 0:2063c10a1022 154 /*LPC_PINCON->PINSEL3 &= ~((3<<4) | (3<<6) | (3<<12) | (3<<22));
slowness 0:2063c10a1022 155 LPC_PINCON->PINSEL3 |= ((1<<4)|(2<<6) | (2<<12) | (2<<22)); // 0x00802080
slowness 0:2063c10a1022 156 */
slowness 0:2063c10a1022 157
slowness 0:2063c10a1022 158 // configure USB D+/D- pins
slowness 0:2063c10a1022 159 /* P0[29] = USB_D+, 01 */
slowness 0:2063c10a1022 160 /* P0[30] = USB_D-, 01 */
slowness 0:2063c10a1022 161 LPC_PINCON->PINSEL1 &= ~((3<<26) | (3<<28));
slowness 0:2063c10a1022 162 LPC_PINCON->PINSEL1 |= ((1<<26)|(1<<28)); // 0x14000000
slowness 0:2063c10a1022 163
slowness 0:2063c10a1022 164 PRINT_Log("Initializing Host Stack\n");
slowness 0:2063c10a1022 165
slowness 0:2063c10a1022 166 Hcca = (volatile HCCA *)(HostBuf+0x000);
slowness 0:2063c10a1022 167 TDHead = (volatile HCTD *)(HostBuf+0x100);
slowness 0:2063c10a1022 168 TDTail = (volatile HCTD *)(HostBuf+0x110);
slowness 0:2063c10a1022 169 EDCtrl = (volatile HCED *)(HostBuf+0x120);
slowness 0:2063c10a1022 170 EDBulkIn = (volatile HCED *)(HostBuf+0x130);
slowness 0:2063c10a1022 171 EDBulkOut = (volatile HCED *)(HostBuf+0x140);
slowness 0:2063c10a1022 172 TDBuffer = (volatile USB_INT08U *)(HostBuf+0x150);
slowness 0:2063c10a1022 173
slowness 0:2063c10a1022 174 /* Initialize all the TDs, EDs and HCCA to 0 */
slowness 0:2063c10a1022 175 Host_EDInit(EDCtrl);
slowness 0:2063c10a1022 176 Host_EDInit(EDBulkIn);
slowness 0:2063c10a1022 177 Host_EDInit(EDBulkOut);
slowness 0:2063c10a1022 178 Host_TDInit(TDHead);
slowness 0:2063c10a1022 179 Host_TDInit(TDTail);
slowness 0:2063c10a1022 180 Host_HCCAInit(Hcca);
slowness 0:2063c10a1022 181
slowness 0:2063c10a1022 182 Host_DelayMS(50); /* Wait 50 ms before apply reset */
slowness 0:2063c10a1022 183 LPC_USB->HcControl = 0; /* HARDWARE RESET */
slowness 0:2063c10a1022 184 LPC_USB->HcControlHeadED = 0; /* Initialize Control list head to Zero */
slowness 0:2063c10a1022 185 LPC_USB->HcBulkHeadED = 0; /* Initialize Bulk list head to Zero */
slowness 0:2063c10a1022 186
slowness 0:2063c10a1022 187 /* SOFTWARE RESET */
slowness 0:2063c10a1022 188 LPC_USB->HcCommandStatus = OR_CMD_STATUS_HCR;
slowness 0:2063c10a1022 189 LPC_USB->HcFmInterval = DEFAULT_FMINTERVAL; /* Write Fm Interval and Largest Data Packet Counter */
slowness 0:2063c10a1022 190
slowness 0:2063c10a1022 191 /* Put HC in operational state */
slowness 0:2063c10a1022 192 LPC_USB->HcControl = (LPC_USB->HcControl & (~OR_CONTROL_HCFS)) | OR_CONTROL_HC_OPER;
slowness 0:2063c10a1022 193 LPC_USB->HcRhStatus = OR_RH_STATUS_LPSC; /* Set Global Power */
slowness 0:2063c10a1022 194
slowness 0:2063c10a1022 195 LPC_USB->HcHCCA = (USB_INT32U)Hcca;
slowness 0:2063c10a1022 196 LPC_USB->HcInterruptStatus |= LPC_USB->HcInterruptStatus; /* Clear Interrrupt Status */
slowness 0:2063c10a1022 197
slowness 0:2063c10a1022 198
slowness 0:2063c10a1022 199 LPC_USB->HcInterruptEnable = OR_INTR_ENABLE_MIE |
slowness 0:2063c10a1022 200 OR_INTR_ENABLE_WDH |
slowness 0:2063c10a1022 201 OR_INTR_ENABLE_RHSC;
slowness 0:2063c10a1022 202
slowness 0:2063c10a1022 203 NVIC_SetPriority(USB_IRQn, 0); /* highest priority */
slowness 0:2063c10a1022 204 /* Enable the USB Interrupt */
slowness 0:2063c10a1022 205 NVIC_EnableIRQ(USB_IRQn);
slowness 0:2063c10a1022 206 PRINT_Log("Host Initialized\n");
slowness 0:2063c10a1022 207 }
slowness 0:2063c10a1022 208
slowness 0:2063c10a1022 209 /*
slowness 0:2063c10a1022 210 **************************************************************************************************************
slowness 0:2063c10a1022 211 * INTERRUPT SERVICE ROUTINE
slowness 0:2063c10a1022 212 *
slowness 0:2063c10a1022 213 * Description: This function services the interrupt caused by host controller
slowness 0:2063c10a1022 214 *
slowness 0:2063c10a1022 215 * Arguments : None
slowness 0:2063c10a1022 216 *
slowness 0:2063c10a1022 217 * Returns : None
slowness 0:2063c10a1022 218 *
slowness 0:2063c10a1022 219 **************************************************************************************************************
slowness 0:2063c10a1022 220 */
slowness 0:2063c10a1022 221
slowness 0:2063c10a1022 222 void USB_IRQHandler (void) __irq
slowness 0:2063c10a1022 223 {
slowness 0:2063c10a1022 224 USB_INT32U int_status;
slowness 0:2063c10a1022 225 USB_INT32U ie_status;
slowness 0:2063c10a1022 226
slowness 0:2063c10a1022 227 int_status = LPC_USB->HcInterruptStatus; /* Read Interrupt Status */
slowness 0:2063c10a1022 228 ie_status = LPC_USB->HcInterruptEnable; /* Read Interrupt enable status */
slowness 0:2063c10a1022 229
slowness 0:2063c10a1022 230 if (!(int_status & ie_status)) {
slowness 0:2063c10a1022 231 return;
slowness 0:2063c10a1022 232 } else {
slowness 0:2063c10a1022 233
slowness 0:2063c10a1022 234 int_status = int_status & ie_status;
slowness 0:2063c10a1022 235 if (int_status & OR_INTR_STATUS_RHSC) { /* Root hub status change interrupt */
slowness 0:2063c10a1022 236 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CSC) {
slowness 0:2063c10a1022 237 if (LPC_USB->HcRhStatus & OR_RH_STATUS_DRWE) {
slowness 0:2063c10a1022 238 /*
slowness 0:2063c10a1022 239 * When DRWE is on, Connect Status Change
slowness 0:2063c10a1022 240 * means a remote wakeup event.
slowness 0:2063c10a1022 241 */
slowness 0:2063c10a1022 242 HOST_RhscIntr = 1;// JUST SOMETHING FOR A BREAKPOINT
slowness 0:2063c10a1022 243 }
slowness 0:2063c10a1022 244 else {
slowness 0:2063c10a1022 245 /*
slowness 0:2063c10a1022 246 * When DRWE is off, Connect Status Change
slowness 0:2063c10a1022 247 * is NOT a remote wakeup event
slowness 0:2063c10a1022 248 */
slowness 0:2063c10a1022 249 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_CCS) {
slowness 0:2063c10a1022 250 if (!gUSBConnected) {
slowness 0:2063c10a1022 251 HOST_TDControlStatus = 0;
slowness 0:2063c10a1022 252 HOST_WdhIntr = 0;
slowness 0:2063c10a1022 253 HOST_RhscIntr = 1;
slowness 0:2063c10a1022 254 gUSBConnected = 1;
slowness 0:2063c10a1022 255 }
slowness 0:2063c10a1022 256 else
slowness 0:2063c10a1022 257 PRINT_Log("Spurious status change (connected)?\n");
slowness 0:2063c10a1022 258 } else {
slowness 0:2063c10a1022 259 if (gUSBConnected) {
slowness 0:2063c10a1022 260 LPC_USB->HcInterruptEnable = 0; // why do we get multiple disc. rupts???
slowness 0:2063c10a1022 261 HOST_RhscIntr = 0;
slowness 0:2063c10a1022 262 gUSBConnected = 0;
slowness 0:2063c10a1022 263 }
slowness 0:2063c10a1022 264 else
slowness 0:2063c10a1022 265 PRINT_Log("Spurious status change (disconnected)?\n");
slowness 0:2063c10a1022 266 }
slowness 0:2063c10a1022 267 }
slowness 0:2063c10a1022 268 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_CSC;
slowness 0:2063c10a1022 269 }
slowness 0:2063c10a1022 270 if (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_PRSC) {
slowness 0:2063c10a1022 271 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC;
slowness 0:2063c10a1022 272 }
slowness 0:2063c10a1022 273 }
slowness 0:2063c10a1022 274 if (int_status & OR_INTR_STATUS_WDH) { /* Writeback Done Head interrupt */
slowness 0:2063c10a1022 275 HOST_WdhIntr = 1;
slowness 0:2063c10a1022 276 HOST_TDControlStatus = (TDHead->Control >> 28) & 0xf;
slowness 0:2063c10a1022 277 }
slowness 0:2063c10a1022 278 LPC_USB->HcInterruptStatus = int_status; /* Clear interrupt status register */
slowness 0:2063c10a1022 279 }
slowness 0:2063c10a1022 280 return;
slowness 0:2063c10a1022 281 }
slowness 0:2063c10a1022 282
slowness 0:2063c10a1022 283 /*
slowness 0:2063c10a1022 284 **************************************************************************************************************
slowness 0:2063c10a1022 285 * PROCESS TRANSFER DESCRIPTOR
slowness 0:2063c10a1022 286 *
slowness 0:2063c10a1022 287 * Description: This function processes the transfer descriptor
slowness 0:2063c10a1022 288 *
slowness 0:2063c10a1022 289 * Arguments : ed Endpoint descriptor that contains this transfer descriptor
slowness 0:2063c10a1022 290 * token SETUP, IN, OUT
slowness 0:2063c10a1022 291 * buffer Current Buffer Pointer of the transfer descriptor
slowness 0:2063c10a1022 292 * buffer_len Length of the buffer
slowness 0:2063c10a1022 293 *
slowness 0:2063c10a1022 294 * Returns : OK if TD submission is successful
slowness 0:2063c10a1022 295 * ERROR if TD submission fails
slowness 0:2063c10a1022 296 *
slowness 0:2063c10a1022 297 **************************************************************************************************************
slowness 0:2063c10a1022 298 */
slowness 0:2063c10a1022 299
slowness 0:2063c10a1022 300 USB_INT32S Host_ProcessTD (volatile HCED *ed,
slowness 0:2063c10a1022 301 volatile USB_INT32U token,
slowness 0:2063c10a1022 302 volatile USB_INT08U *buffer,
slowness 0:2063c10a1022 303 USB_INT32U buffer_len)
slowness 0:2063c10a1022 304 {
slowness 0:2063c10a1022 305 volatile USB_INT32U td_toggle;
slowness 0:2063c10a1022 306
slowness 0:2063c10a1022 307
slowness 0:2063c10a1022 308 if (ed == EDCtrl) {
slowness 0:2063c10a1022 309 if (token == TD_SETUP) {
slowness 0:2063c10a1022 310 td_toggle = TD_TOGGLE_0;
slowness 0:2063c10a1022 311 } else {
slowness 0:2063c10a1022 312 td_toggle = TD_TOGGLE_1;
slowness 0:2063c10a1022 313 }
slowness 0:2063c10a1022 314 } else {
slowness 0:2063c10a1022 315 td_toggle = 0;
slowness 0:2063c10a1022 316 }
slowness 0:2063c10a1022 317 TDHead->Control = (TD_ROUNDING |
slowness 0:2063c10a1022 318 token |
slowness 0:2063c10a1022 319 TD_DELAY_INT(0) |
slowness 0:2063c10a1022 320 td_toggle |
slowness 0:2063c10a1022 321 TD_CC);
slowness 0:2063c10a1022 322 TDTail->Control = 0;
slowness 0:2063c10a1022 323 TDHead->CurrBufPtr = (USB_INT32U) buffer;
slowness 0:2063c10a1022 324 TDTail->CurrBufPtr = 0;
slowness 0:2063c10a1022 325 TDHead->Next = (USB_INT32U) TDTail;
slowness 0:2063c10a1022 326 TDTail->Next = 0;
slowness 0:2063c10a1022 327 TDHead->BufEnd = (USB_INT32U)(buffer + (buffer_len - 1));
slowness 0:2063c10a1022 328 TDTail->BufEnd = 0;
slowness 0:2063c10a1022 329
slowness 0:2063c10a1022 330 ed->HeadTd = (USB_INT32U)TDHead | ((ed->HeadTd) & 0x00000002);
slowness 0:2063c10a1022 331 ed->TailTd = (USB_INT32U)TDTail;
slowness 0:2063c10a1022 332 ed->Next = 0;
slowness 0:2063c10a1022 333
slowness 0:2063c10a1022 334 if (ed == EDCtrl) {
slowness 0:2063c10a1022 335 LPC_USB->HcControlHeadED = (USB_INT32U)ed;
slowness 0:2063c10a1022 336 LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus | OR_CMD_STATUS_CLF;
slowness 0:2063c10a1022 337 LPC_USB->HcControl = LPC_USB->HcControl | OR_CONTROL_CLE;
slowness 0:2063c10a1022 338 } else {
slowness 0:2063c10a1022 339 LPC_USB->HcBulkHeadED = (USB_INT32U)ed;
slowness 0:2063c10a1022 340 LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus | OR_CMD_STATUS_BLF;
slowness 0:2063c10a1022 341 LPC_USB->HcControl = LPC_USB->HcControl | OR_CONTROL_BLE;
slowness 0:2063c10a1022 342 }
slowness 0:2063c10a1022 343
slowness 0:2063c10a1022 344 Host_WDHWait();
slowness 0:2063c10a1022 345
slowness 0:2063c10a1022 346 // if (!(TDHead->Control & 0xF0000000)) {
slowness 0:2063c10a1022 347 if (!HOST_TDControlStatus) {
slowness 0:2063c10a1022 348 return (OK);
slowness 0:2063c10a1022 349 } else {
slowness 0:2063c10a1022 350 return (ERR_TD_FAIL);
slowness 0:2063c10a1022 351 }
slowness 0:2063c10a1022 352 }
slowness 0:2063c10a1022 353
slowness 0:2063c10a1022 354 /*
slowness 0:2063c10a1022 355 **************************************************************************************************************
slowness 0:2063c10a1022 356 * ENUMERATE THE DEVICE
slowness 0:2063c10a1022 357 *
slowness 0:2063c10a1022 358 * Description: This function is used to enumerate the device connected
slowness 0:2063c10a1022 359 *
slowness 0:2063c10a1022 360 * Arguments : None
slowness 0:2063c10a1022 361 *
slowness 0:2063c10a1022 362 * Returns : None
slowness 0:2063c10a1022 363 *
slowness 0:2063c10a1022 364 **************************************************************************************************************
slowness 0:2063c10a1022 365 */
slowness 0:2063c10a1022 366
slowness 0:2063c10a1022 367 USB_INT32S Host_EnumDev (void)
slowness 0:2063c10a1022 368 {
slowness 0:2063c10a1022 369 USB_INT32S rc;
slowness 0:2063c10a1022 370
slowness 0:2063c10a1022 371 PRINT_Log("Connect a Mass Storage device\n");
slowness 0:2063c10a1022 372 while (!HOST_RhscIntr)
slowness 0:2063c10a1022 373 __WFI();
slowness 0:2063c10a1022 374 Host_DelayMS(100); /* USB 2.0 spec says atleast 50ms delay beore port reset */
slowness 0:2063c10a1022 375 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRS; // Initiate port reset
slowness 0:2063c10a1022 376 while (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_PRS)
slowness 0:2063c10a1022 377 __WFI(); // Wait for port reset to complete...
slowness 0:2063c10a1022 378 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC; // ...and clear port reset signal
slowness 0:2063c10a1022 379 Host_DelayMS(200); /* Wait for 100 MS after port reset */
slowness 0:2063c10a1022 380
slowness 0:2063c10a1022 381 EDCtrl->Control = 8 << 16; /* Put max pkt size = 8 */
slowness 0:2063c10a1022 382 /* Read first 8 bytes of device desc */
slowness 0:2063c10a1022 383 rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_DEVICE, 0, TDBuffer, 8);
slowness 0:2063c10a1022 384 if (rc != OK) {
slowness 0:2063c10a1022 385 PRINT_Err(rc);
slowness 0:2063c10a1022 386 return (rc);
slowness 0:2063c10a1022 387 }
slowness 0:2063c10a1022 388 EDCtrl->Control = TDBuffer[7] << 16; /* Get max pkt size of endpoint 0 */
slowness 0:2063c10a1022 389 rc = HOST_SET_ADDRESS(1); /* Set the device address to 1 */
slowness 0:2063c10a1022 390 if (rc != OK) {
slowness 0:2063c10a1022 391 PRINT_Err(rc);
slowness 0:2063c10a1022 392 return (rc);
slowness 0:2063c10a1022 393 }
slowness 0:2063c10a1022 394 Host_DelayMS(2);
slowness 0:2063c10a1022 395 EDCtrl->Control = (EDCtrl->Control) | 1; /* Modify control pipe with address 1 */
slowness 0:2063c10a1022 396 /* Get the configuration descriptor */
slowness 0:2063c10a1022 397 rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_CONFIGURATION, 0, TDBuffer, 9);
slowness 0:2063c10a1022 398 if (rc != OK) {
slowness 0:2063c10a1022 399 PRINT_Err(rc);
slowness 0:2063c10a1022 400 return (rc);
slowness 0:2063c10a1022 401 }
slowness 0:2063c10a1022 402 /* Get the first configuration data */
slowness 0:2063c10a1022 403 rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_CONFIGURATION, 0, TDBuffer, ReadLE16U(&TDBuffer[2]));
slowness 0:2063c10a1022 404 if (rc != OK) {
slowness 0:2063c10a1022 405 PRINT_Err(rc);
slowness 0:2063c10a1022 406 return (rc);
slowness 0:2063c10a1022 407 }
slowness 0:2063c10a1022 408 rc = MS_ParseConfiguration(); /* Parse the configuration */
slowness 0:2063c10a1022 409 if (rc != OK) {
slowness 0:2063c10a1022 410 PRINT_Err(rc);
slowness 0:2063c10a1022 411 return (rc);
slowness 0:2063c10a1022 412 }
slowness 0:2063c10a1022 413 rc = USBH_SET_CONFIGURATION(1); /* Select device configuration 1 */
slowness 0:2063c10a1022 414 if (rc != OK) {
slowness 0:2063c10a1022 415 PRINT_Err(rc);
slowness 0:2063c10a1022 416 }
slowness 0:2063c10a1022 417 Host_DelayMS(100); /* Some devices may require this delay */
slowness 0:2063c10a1022 418 return (rc);
slowness 0:2063c10a1022 419 }
slowness 0:2063c10a1022 420
slowness 0:2063c10a1022 421 /*
slowness 0:2063c10a1022 422 **************************************************************************************************************
slowness 0:2063c10a1022 423 * RECEIVE THE CONTROL INFORMATION
slowness 0:2063c10a1022 424 *
slowness 0:2063c10a1022 425 * Description: This function is used to receive the control information
slowness 0:2063c10a1022 426 *
slowness 0:2063c10a1022 427 * Arguments : bm_request_type
slowness 0:2063c10a1022 428 * b_request
slowness 0:2063c10a1022 429 * w_value
slowness 0:2063c10a1022 430 * w_index
slowness 0:2063c10a1022 431 * w_length
slowness 0:2063c10a1022 432 * buffer
slowness 0:2063c10a1022 433 *
slowness 0:2063c10a1022 434 * Returns : OK if Success
slowness 0:2063c10a1022 435 * ERROR if Failed
slowness 0:2063c10a1022 436 *
slowness 0:2063c10a1022 437 **************************************************************************************************************
slowness 0:2063c10a1022 438 */
slowness 0:2063c10a1022 439
slowness 0:2063c10a1022 440 USB_INT32S Host_CtrlRecv ( USB_INT08U bm_request_type,
slowness 0:2063c10a1022 441 USB_INT08U b_request,
slowness 0:2063c10a1022 442 USB_INT16U w_value,
slowness 0:2063c10a1022 443 USB_INT16U w_index,
slowness 0:2063c10a1022 444 USB_INT16U w_length,
slowness 0:2063c10a1022 445 volatile USB_INT08U *buffer)
slowness 0:2063c10a1022 446 {
slowness 0:2063c10a1022 447 USB_INT32S rc;
slowness 0:2063c10a1022 448
slowness 0:2063c10a1022 449
slowness 0:2063c10a1022 450 Host_FillSetup(bm_request_type, b_request, w_value, w_index, w_length);
slowness 0:2063c10a1022 451 rc = Host_ProcessTD(EDCtrl, TD_SETUP, TDBuffer, 8);
slowness 0:2063c10a1022 452 if (rc == OK) {
slowness 0:2063c10a1022 453 if (w_length) {
slowness 0:2063c10a1022 454 rc = Host_ProcessTD(EDCtrl, TD_IN, TDBuffer, w_length);
slowness 0:2063c10a1022 455 }
slowness 0:2063c10a1022 456 if (rc == OK) {
slowness 0:2063c10a1022 457 rc = Host_ProcessTD(EDCtrl, TD_OUT, NULL, 0);
slowness 0:2063c10a1022 458 }
slowness 0:2063c10a1022 459 }
slowness 0:2063c10a1022 460 return (rc);
slowness 0:2063c10a1022 461 }
slowness 0:2063c10a1022 462
slowness 0:2063c10a1022 463 /*
slowness 0:2063c10a1022 464 **************************************************************************************************************
slowness 0:2063c10a1022 465 * SEND THE CONTROL INFORMATION
slowness 0:2063c10a1022 466 *
slowness 0:2063c10a1022 467 * Description: This function is used to send the control information
slowness 0:2063c10a1022 468 *
slowness 0:2063c10a1022 469 * Arguments : None
slowness 0:2063c10a1022 470 *
slowness 0:2063c10a1022 471 * Returns : OK if Success
slowness 0:2063c10a1022 472 * ERR_INVALID_BOOTSIG if Failed
slowness 0:2063c10a1022 473 *
slowness 0:2063c10a1022 474 **************************************************************************************************************
slowness 0:2063c10a1022 475 */
slowness 0:2063c10a1022 476
slowness 0:2063c10a1022 477 USB_INT32S Host_CtrlSend ( USB_INT08U bm_request_type,
slowness 0:2063c10a1022 478 USB_INT08U b_request,
slowness 0:2063c10a1022 479 USB_INT16U w_value,
slowness 0:2063c10a1022 480 USB_INT16U w_index,
slowness 0:2063c10a1022 481 USB_INT16U w_length,
slowness 0:2063c10a1022 482 volatile USB_INT08U *buffer)
slowness 0:2063c10a1022 483 {
slowness 0:2063c10a1022 484 USB_INT32S rc;
slowness 0:2063c10a1022 485
slowness 0:2063c10a1022 486
slowness 0:2063c10a1022 487 Host_FillSetup(bm_request_type, b_request, w_value, w_index, w_length);
slowness 0:2063c10a1022 488
slowness 0:2063c10a1022 489 rc = Host_ProcessTD(EDCtrl, TD_SETUP, TDBuffer, 8);
slowness 0:2063c10a1022 490 if (rc == OK) {
slowness 0:2063c10a1022 491 if (w_length) {
slowness 0:2063c10a1022 492 rc = Host_ProcessTD(EDCtrl, TD_OUT, TDBuffer, w_length);
slowness 0:2063c10a1022 493 }
slowness 0:2063c10a1022 494 if (rc == OK) {
slowness 0:2063c10a1022 495 rc = Host_ProcessTD(EDCtrl, TD_IN, NULL, 0);
slowness 0:2063c10a1022 496 }
slowness 0:2063c10a1022 497 }
slowness 0:2063c10a1022 498 return (rc);
slowness 0:2063c10a1022 499 }
slowness 0:2063c10a1022 500
slowness 0:2063c10a1022 501 /*
slowness 0:2063c10a1022 502 **************************************************************************************************************
slowness 0:2063c10a1022 503 * FILL SETUP PACKET
slowness 0:2063c10a1022 504 *
slowness 0:2063c10a1022 505 * Description: This function is used to fill the setup packet
slowness 0:2063c10a1022 506 *
slowness 0:2063c10a1022 507 * Arguments : None
slowness 0:2063c10a1022 508 *
slowness 0:2063c10a1022 509 * Returns : OK if Success
slowness 0:2063c10a1022 510 * ERR_INVALID_BOOTSIG if Failed
slowness 0:2063c10a1022 511 *
slowness 0:2063c10a1022 512 **************************************************************************************************************
slowness 0:2063c10a1022 513 */
slowness 0:2063c10a1022 514
slowness 0:2063c10a1022 515 void Host_FillSetup (USB_INT08U bm_request_type,
slowness 0:2063c10a1022 516 USB_INT08U b_request,
slowness 0:2063c10a1022 517 USB_INT16U w_value,
slowness 0:2063c10a1022 518 USB_INT16U w_index,
slowness 0:2063c10a1022 519 USB_INT16U w_length)
slowness 0:2063c10a1022 520 {
slowness 0:2063c10a1022 521 int i;
slowness 0:2063c10a1022 522 for (i=0;i<w_length;i++)
slowness 0:2063c10a1022 523 TDBuffer[i] = 0;
slowness 0:2063c10a1022 524
slowness 0:2063c10a1022 525 TDBuffer[0] = bm_request_type;
slowness 0:2063c10a1022 526 TDBuffer[1] = b_request;
slowness 0:2063c10a1022 527 WriteLE16U(&TDBuffer[2], w_value);
slowness 0:2063c10a1022 528 WriteLE16U(&TDBuffer[4], w_index);
slowness 0:2063c10a1022 529 WriteLE16U(&TDBuffer[6], w_length);
slowness 0:2063c10a1022 530 }
slowness 0:2063c10a1022 531
slowness 0:2063c10a1022 532
slowness 0:2063c10a1022 533
slowness 0:2063c10a1022 534 /*
slowness 0:2063c10a1022 535 **************************************************************************************************************
slowness 0:2063c10a1022 536 * INITIALIZE THE TRANSFER DESCRIPTOR
slowness 0:2063c10a1022 537 *
slowness 0:2063c10a1022 538 * Description: This function initializes transfer descriptor
slowness 0:2063c10a1022 539 *
slowness 0:2063c10a1022 540 * Arguments : Pointer to TD structure
slowness 0:2063c10a1022 541 *
slowness 0:2063c10a1022 542 * Returns : None
slowness 0:2063c10a1022 543 *
slowness 0:2063c10a1022 544 **************************************************************************************************************
slowness 0:2063c10a1022 545 */
slowness 0:2063c10a1022 546
slowness 0:2063c10a1022 547 void Host_TDInit (volatile HCTD *td)
slowness 0:2063c10a1022 548 {
slowness 0:2063c10a1022 549
slowness 0:2063c10a1022 550 td->Control = 0;
slowness 0:2063c10a1022 551 td->CurrBufPtr = 0;
slowness 0:2063c10a1022 552 td->Next = 0;
slowness 0:2063c10a1022 553 td->BufEnd = 0;
slowness 0:2063c10a1022 554 }
slowness 0:2063c10a1022 555
slowness 0:2063c10a1022 556 /*
slowness 0:2063c10a1022 557 **************************************************************************************************************
slowness 0:2063c10a1022 558 * INITIALIZE THE ENDPOINT DESCRIPTOR
slowness 0:2063c10a1022 559 *
slowness 0:2063c10a1022 560 * Description: This function initializes endpoint descriptor
slowness 0:2063c10a1022 561 *
slowness 0:2063c10a1022 562 * Arguments : Pointer to ED strcuture
slowness 0:2063c10a1022 563 *
slowness 0:2063c10a1022 564 * Returns : None
slowness 0:2063c10a1022 565 *
slowness 0:2063c10a1022 566 **************************************************************************************************************
slowness 0:2063c10a1022 567 */
slowness 0:2063c10a1022 568
slowness 0:2063c10a1022 569 void Host_EDInit (volatile HCED *ed)
slowness 0:2063c10a1022 570 {
slowness 0:2063c10a1022 571
slowness 0:2063c10a1022 572 ed->Control = 0;
slowness 0:2063c10a1022 573 ed->TailTd = 0;
slowness 0:2063c10a1022 574 ed->HeadTd = 0;
slowness 0:2063c10a1022 575 ed->Next = 0;
slowness 0:2063c10a1022 576 }
slowness 0:2063c10a1022 577
slowness 0:2063c10a1022 578 /*
slowness 0:2063c10a1022 579 **************************************************************************************************************
slowness 0:2063c10a1022 580 * INITIALIZE HOST CONTROLLER COMMUNICATIONS AREA
slowness 0:2063c10a1022 581 *
slowness 0:2063c10a1022 582 * Description: This function initializes host controller communications area
slowness 0:2063c10a1022 583 *
slowness 0:2063c10a1022 584 * Arguments : Pointer to HCCA
slowness 0:2063c10a1022 585 *
slowness 0:2063c10a1022 586 * Returns :
slowness 0:2063c10a1022 587 *
slowness 0:2063c10a1022 588 **************************************************************************************************************
slowness 0:2063c10a1022 589 */
slowness 0:2063c10a1022 590
slowness 0:2063c10a1022 591 void Host_HCCAInit (volatile HCCA *hcca)
slowness 0:2063c10a1022 592 {
slowness 0:2063c10a1022 593 USB_INT32U i;
slowness 0:2063c10a1022 594
slowness 0:2063c10a1022 595
slowness 0:2063c10a1022 596 for (i = 0; i < 32; i++) {
slowness 0:2063c10a1022 597
slowness 0:2063c10a1022 598 hcca->IntTable[i] = 0;
slowness 0:2063c10a1022 599 hcca->FrameNumber = 0;
slowness 0:2063c10a1022 600 hcca->DoneHead = 0;
slowness 0:2063c10a1022 601 }
slowness 0:2063c10a1022 602
slowness 0:2063c10a1022 603 }
slowness 0:2063c10a1022 604
slowness 0:2063c10a1022 605 /*
slowness 0:2063c10a1022 606 **************************************************************************************************************
slowness 0:2063c10a1022 607 * WAIT FOR WDH INTERRUPT
slowness 0:2063c10a1022 608 *
slowness 0:2063c10a1022 609 * Description: This function is infinite loop which breaks when ever a WDH interrupt rises
slowness 0:2063c10a1022 610 *
slowness 0:2063c10a1022 611 * Arguments : None
slowness 0:2063c10a1022 612 *
slowness 0:2063c10a1022 613 * Returns : None
slowness 0:2063c10a1022 614 *
slowness 0:2063c10a1022 615 **************************************************************************************************************
slowness 0:2063c10a1022 616 */
slowness 0:2063c10a1022 617
slowness 0:2063c10a1022 618 void Host_WDHWait (void)
slowness 0:2063c10a1022 619 {
slowness 0:2063c10a1022 620 while (!HOST_WdhIntr)
slowness 0:2063c10a1022 621 __WFI();
slowness 0:2063c10a1022 622
slowness 0:2063c10a1022 623 HOST_WdhIntr = 0;
slowness 0:2063c10a1022 624 }
slowness 0:2063c10a1022 625
slowness 0:2063c10a1022 626 /*
slowness 0:2063c10a1022 627 **************************************************************************************************************
slowness 0:2063c10a1022 628 * READ LE 32U
slowness 0:2063c10a1022 629 *
slowness 0:2063c10a1022 630 * Description: This function is used to read an unsigned integer from a character buffer in the platform
slowness 0:2063c10a1022 631 * containing little endian processor
slowness 0:2063c10a1022 632 *
slowness 0:2063c10a1022 633 * Arguments : pmem Pointer to the character buffer
slowness 0:2063c10a1022 634 *
slowness 0:2063c10a1022 635 * Returns : val Unsigned integer
slowness 0:2063c10a1022 636 *
slowness 0:2063c10a1022 637 **************************************************************************************************************
slowness 0:2063c10a1022 638 */
slowness 0:2063c10a1022 639
slowness 0:2063c10a1022 640 USB_INT32U ReadLE32U (volatile USB_INT08U *pmem)
slowness 0:2063c10a1022 641 {
slowness 0:2063c10a1022 642 USB_INT32U val = *(USB_INT32U*)pmem;
slowness 0:2063c10a1022 643 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 644 return __REV(val);
slowness 0:2063c10a1022 645 #else
slowness 0:2063c10a1022 646 return val;
slowness 0:2063c10a1022 647 #endif
slowness 0:2063c10a1022 648 }
slowness 0:2063c10a1022 649
slowness 0:2063c10a1022 650 /*
slowness 0:2063c10a1022 651 **************************************************************************************************************
slowness 0:2063c10a1022 652 * WRITE LE 32U
slowness 0:2063c10a1022 653 *
slowness 0:2063c10a1022 654 * Description: This function is used to write an unsigned integer into a charecter buffer in the platform
slowness 0:2063c10a1022 655 * containing little endian processor.
slowness 0:2063c10a1022 656 *
slowness 0:2063c10a1022 657 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 658 * val Integer value to be placed in the charecter buffer
slowness 0:2063c10a1022 659 *
slowness 0:2063c10a1022 660 * Returns : None
slowness 0:2063c10a1022 661 *
slowness 0:2063c10a1022 662 **************************************************************************************************************
slowness 0:2063c10a1022 663 */
slowness 0:2063c10a1022 664
slowness 0:2063c10a1022 665 void WriteLE32U (volatile USB_INT08U *pmem,
slowness 0:2063c10a1022 666 USB_INT32U val)
slowness 0:2063c10a1022 667 {
slowness 0:2063c10a1022 668 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 669 *(USB_INT32U*)pmem = __REV(val);
slowness 0:2063c10a1022 670 #else
slowness 0:2063c10a1022 671 *(USB_INT32U*)pmem = val;
slowness 0:2063c10a1022 672 #endif
slowness 0:2063c10a1022 673 }
slowness 0:2063c10a1022 674
slowness 0:2063c10a1022 675 /*
slowness 0:2063c10a1022 676 **************************************************************************************************************
slowness 0:2063c10a1022 677 * READ LE 16U
slowness 0:2063c10a1022 678 *
slowness 0:2063c10a1022 679 * Description: This function is used to read an unsigned short integer from a charecter buffer in the platform
slowness 0:2063c10a1022 680 * containing little endian processor
slowness 0:2063c10a1022 681 *
slowness 0:2063c10a1022 682 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 683 *
slowness 0:2063c10a1022 684 * Returns : val Unsigned short integer
slowness 0:2063c10a1022 685 *
slowness 0:2063c10a1022 686 **************************************************************************************************************
slowness 0:2063c10a1022 687 */
slowness 0:2063c10a1022 688
slowness 0:2063c10a1022 689 USB_INT16U ReadLE16U (volatile USB_INT08U *pmem)
slowness 0:2063c10a1022 690 {
slowness 0:2063c10a1022 691 USB_INT16U val = *(USB_INT16U*)pmem;
slowness 0:2063c10a1022 692 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 693 return __REV16(val);
slowness 0:2063c10a1022 694 #else
slowness 0:2063c10a1022 695 return val;
slowness 0:2063c10a1022 696 #endif
slowness 0:2063c10a1022 697 }
slowness 0:2063c10a1022 698
slowness 0:2063c10a1022 699 /*
slowness 0:2063c10a1022 700 **************************************************************************************************************
slowness 0:2063c10a1022 701 * WRITE LE 16U
slowness 0:2063c10a1022 702 *
slowness 0:2063c10a1022 703 * Description: This function is used to write an unsigned short integer into a charecter buffer in the
slowness 0:2063c10a1022 704 * platform containing little endian processor
slowness 0:2063c10a1022 705 *
slowness 0:2063c10a1022 706 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 707 * val Value to be placed in the charecter buffer
slowness 0:2063c10a1022 708 *
slowness 0:2063c10a1022 709 * Returns : None
slowness 0:2063c10a1022 710 *
slowness 0:2063c10a1022 711 **************************************************************************************************************
slowness 0:2063c10a1022 712 */
slowness 0:2063c10a1022 713
slowness 0:2063c10a1022 714 void WriteLE16U (volatile USB_INT08U *pmem,
slowness 0:2063c10a1022 715 USB_INT16U val)
slowness 0:2063c10a1022 716 {
slowness 0:2063c10a1022 717 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 718 *(USB_INT16U*)pmem = (__REV16(val) & 0xFFFF);
slowness 0:2063c10a1022 719 #else
slowness 0:2063c10a1022 720 *(USB_INT16U*)pmem = val;
slowness 0:2063c10a1022 721 #endif
slowness 0:2063c10a1022 722 }
slowness 0:2063c10a1022 723
slowness 0:2063c10a1022 724 /*
slowness 0:2063c10a1022 725 **************************************************************************************************************
slowness 0:2063c10a1022 726 * READ BE 32U
slowness 0:2063c10a1022 727 *
slowness 0:2063c10a1022 728 * Description: This function is used to read an unsigned integer from a charecter buffer in the platform
slowness 0:2063c10a1022 729 * containing big endian processor
slowness 0:2063c10a1022 730 *
slowness 0:2063c10a1022 731 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 732 *
slowness 0:2063c10a1022 733 * Returns : val Unsigned integer
slowness 0:2063c10a1022 734 *
slowness 0:2063c10a1022 735 **************************************************************************************************************
slowness 0:2063c10a1022 736 */
slowness 0:2063c10a1022 737
slowness 0:2063c10a1022 738 USB_INT32U ReadBE32U (volatile USB_INT08U *pmem)
slowness 0:2063c10a1022 739 {
slowness 0:2063c10a1022 740 USB_INT32U val = *(USB_INT32U*)pmem;
slowness 0:2063c10a1022 741 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 742 return val;
slowness 0:2063c10a1022 743 #else
slowness 0:2063c10a1022 744 return __REV(val);
slowness 0:2063c10a1022 745 #endif
slowness 0:2063c10a1022 746 }
slowness 0:2063c10a1022 747
slowness 0:2063c10a1022 748 /*
slowness 0:2063c10a1022 749 **************************************************************************************************************
slowness 0:2063c10a1022 750 * WRITE BE 32U
slowness 0:2063c10a1022 751 *
slowness 0:2063c10a1022 752 * Description: This function is used to write an unsigned integer into a charecter buffer in the platform
slowness 0:2063c10a1022 753 * containing big endian processor
slowness 0:2063c10a1022 754 *
slowness 0:2063c10a1022 755 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 756 * val Value to be placed in the charecter buffer
slowness 0:2063c10a1022 757 *
slowness 0:2063c10a1022 758 * Returns : None
slowness 0:2063c10a1022 759 *
slowness 0:2063c10a1022 760 **************************************************************************************************************
slowness 0:2063c10a1022 761 */
slowness 0:2063c10a1022 762
slowness 0:2063c10a1022 763 void WriteBE32U (volatile USB_INT08U *pmem,
slowness 0:2063c10a1022 764 USB_INT32U val)
slowness 0:2063c10a1022 765 {
slowness 0:2063c10a1022 766 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 767 *(USB_INT32U*)pmem = val;
slowness 0:2063c10a1022 768 #else
slowness 0:2063c10a1022 769 *(USB_INT32U*)pmem = __REV(val);
slowness 0:2063c10a1022 770 #endif
slowness 0:2063c10a1022 771 }
slowness 0:2063c10a1022 772
slowness 0:2063c10a1022 773 /*
slowness 0:2063c10a1022 774 **************************************************************************************************************
slowness 0:2063c10a1022 775 * READ BE 16U
slowness 0:2063c10a1022 776 *
slowness 0:2063c10a1022 777 * Description: This function is used to read an unsigned short integer from a charecter buffer in the platform
slowness 0:2063c10a1022 778 * containing big endian processor
slowness 0:2063c10a1022 779 *
slowness 0:2063c10a1022 780 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 781 *
slowness 0:2063c10a1022 782 * Returns : val Unsigned short integer
slowness 0:2063c10a1022 783 *
slowness 0:2063c10a1022 784 **************************************************************************************************************
slowness 0:2063c10a1022 785 */
slowness 0:2063c10a1022 786
slowness 0:2063c10a1022 787 USB_INT16U ReadBE16U (volatile USB_INT08U *pmem)
slowness 0:2063c10a1022 788 {
slowness 0:2063c10a1022 789 USB_INT16U val = *(USB_INT16U*)pmem;
slowness 0:2063c10a1022 790 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 791 return val;
slowness 0:2063c10a1022 792 #else
slowness 0:2063c10a1022 793 return __REV16(val);
slowness 0:2063c10a1022 794 #endif
slowness 0:2063c10a1022 795 }
slowness 0:2063c10a1022 796
slowness 0:2063c10a1022 797 /*
slowness 0:2063c10a1022 798 **************************************************************************************************************
slowness 0:2063c10a1022 799 * WRITE BE 16U
slowness 0:2063c10a1022 800 *
slowness 0:2063c10a1022 801 * Description: This function is used to write an unsigned short integer into the charecter buffer in the
slowness 0:2063c10a1022 802 * platform containing big endian processor
slowness 0:2063c10a1022 803 *
slowness 0:2063c10a1022 804 * Arguments : pmem Pointer to the charecter buffer
slowness 0:2063c10a1022 805 * val Value to be placed in the charecter buffer
slowness 0:2063c10a1022 806 *
slowness 0:2063c10a1022 807 * Returns : None
slowness 0:2063c10a1022 808 *
slowness 0:2063c10a1022 809 **************************************************************************************************************
slowness 0:2063c10a1022 810 */
slowness 0:2063c10a1022 811
slowness 0:2063c10a1022 812 void WriteBE16U (volatile USB_INT08U *pmem,
slowness 0:2063c10a1022 813 USB_INT16U val)
slowness 0:2063c10a1022 814 {
slowness 0:2063c10a1022 815 #ifdef __BIG_ENDIAN
slowness 0:2063c10a1022 816 *(USB_INT16U*)pmem = val;
slowness 0:2063c10a1022 817 #else
slowness 0:2063c10a1022 818 *(USB_INT16U*)pmem = (__REV16(val) & 0xFFFF);
slowness 0:2063c10a1022 819 #endif
slowness 0:2063c10a1022 820 }