firmware update from USB stick, does not work properly. If someone can get it work, please inform me.

Dependencies:   mbed

Committer:
Markus_Paar
Date:
Fri Apr 01 07:51:52 2011 +0000
Revision:
0:dad421e28e26
0.1

Who changed what in which revision?

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