Samir Bouaziz / FileSystem_POPS

Dependencies:   FatFileSystemCpp USBHostLite

Dependents:   m3PI_TP_POPS_II2015v0 m3PI_TP_POPS_II2015v0 ourproject m3PI_TP_SETI ... more

Committer:
WiredHome
Date:
Fri Oct 11 02:34:51 2013 +0000
Revision:
1:19a776ced714
Parent:
0:7304356c0790
Incorporate SD as well as USB File System.

Who changed what in which revision?

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