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