Bender Robotics / USBHostLite

disable unnecessary prints

Dependents:   PLAUCI_full

usbhost_lpc17xx.cpp@0:e042bdf9c219, 2015-10-22 (annotated)

Committer:
legwinskij
Date:
Thu Oct 22 17:16:11 2015 +0000
Revision:
0:e042bdf9c219
Child:
1:1538f5588c56
Completely refactored fw, changelog in main

Who changed what in which revision?

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