mbed Dev board test program

Dependencies:   EthernetNetIf mbed HTTPServer SerialLCD

Committer:
pangsk
Date:
Mon Jul 11 15:02:04 2011 +0000
Revision:
0:0f36b9fac4c5

        

Who changed what in which revision?

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