Read GPS MT3329

Dependencies:   FatFileSystem mbed

Committer:
belloula
Date:
Sun Mar 29 14:43:22 2015 +0000
Revision:
0:9611b40fec6f
Read from MT3329 GPS and print on Pc (usb serial pc)

Who changed what in which revision?

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