YongChing Tee / Mbed 2 deprecated Lab3

Publish code

Dependencies:   FatFileSystem RPG TextLCD mbed wave_player

USBHostLite/usbhost_lpc17xx.cpp@1:ebb980d204ae, 2013-03-06 (annotated)

Committer:
YongChingTee
Date:
Wed Mar 06 00:21:35 2013 +0000
Revision:
1:ebb980d204ae
Parent:
0:ad48675db853 
publish

Who changed what in which revision?

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