123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659 |
- #include "usb_firmware_library_headers.h"
- #include "hal_types.h"
- #include "hal_board.h"
- void usbsrGetStatus(void)
- {
- uint8 endpoint;
- static uint16 __xdata status;
-
- if (usbSetupHeader.value || HI_UINT16(usbSetupHeader.index) || (usbSetupHeader.length != 2)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- switch (usbSetupHeader.requestType) {
-
-
-
- case RT_IN_DEVICE:
-
- if (LO_UINT16(usbSetupHeader.index)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
-
- status = usbfwData.selfPowered ? 0x0001 : 0x0000;
-
- if (usbfwData.remoteWakeup) status |= 0x0002;
- }
- break;
-
-
- case RT_IN_INTERFACE:
-
- if (usbfwData.usbState != DEV_CONFIGURED) {
- usbfwData.ep0Status = EP_STALL;
- } else {
- status = 0x0000;
- }
- break;
-
-
- case RT_IN_ENDPOINT:
- endpoint = LO_UINT16(usbSetupHeader.index) & 0x7F;
-
- if ((usbfwData.usbState != DEV_CONFIGURED) || (endpoint > 5)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
-
- if (LO_UINT16(usbSetupHeader.index) & 0x80) {
- status = (usbfwData.pEpInStatus[endpoint - 1] == EP_HALT) ? 0x0001 : 0x0000;
-
- } else {
- status = (usbfwData.pEpOutStatus[endpoint - 1] == EP_HALT) ? 0x0001 : 0x0000;
- }
- }
- break;
- default:
- usbfwData.ep0Status = EP_STALL;
- break;
- }
- if (usbfwData.ep0Status != EP_STALL) {
-
- usbSetupData.pBuffer = (uint8 __generic *)&status;
- usbSetupData.bytesLeft = 2;
- usbfwData.ep0Status = EP_TX;
- }
- }
- }
- static uint8 ChangeFeature(uint8 set)
- {
- uint8 endpoint;
-
- if (usbSetupHeader.length || (usbfwData.usbState != DEV_CONFIGURED) && (usbSetupHeader.index != 0)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- switch (usbSetupHeader.requestType & RT_MASK_RECIP) {
-
- case RT_RECIP_DEV:
-
- if (LO_UINT16(usbSetupHeader.value) != DEVICE_REMOTE_WAKEUP) {
- return FALSE;
- } else {
- usbfwData.remoteWakeup = set;
- usbsrHookProcessEvent(set ? USBSR_EVENT_REMOTE_WAKEUP_ENABLED : USBSR_EVENT_REMOTE_WAKEUP_DISABLED, 0);
- }
- break;
-
- case RT_RECIP_IF:
- return FALSE;
-
- case RT_RECIP_EP:
- endpoint = LO_UINT16(usbSetupHeader.index) & 0x7F;
-
- if (LO_UINT16(usbSetupHeader.value) != ENDPOINT_HALT) {
- return FALSE;
- } else if (endpoint > 5) {
- usbfwData.ep0Status = EP_STALL;
- } else {
- USBFW_SELECT_ENDPOINT(endpoint);
-
- if (LO_UINT16(usbSetupHeader.index) & 0x80) {
- USBCSIL = set ? USBCSIL_SEND_STALL : USBCSIL_CLR_DATA_TOG;
- usbfwData.pEpInStatus[endpoint - 1] = set ? EP_HALT : EP_IDLE;
- usbsrHookProcessEvent(set ? USBSR_EVENT_EPIN_STALL_SET : USBSR_EVENT_EPIN_STALL_CLEARED, endpoint);
-
- } else {
- USBCSOL = set ? USBCSOL_SEND_STALL : USBCSOL_CLR_DATA_TOG;
- usbfwData.pEpOutStatus[endpoint - 1] = set ? EP_HALT : EP_IDLE;
- usbsrHookProcessEvent(set ? USBSR_EVENT_EPOUT_STALL_SET : USBSR_EVENT_EPOUT_STALL_CLEARED, endpoint);
- }
- USBFW_SELECT_ENDPOINT(0);
- }
- break;
- default:
- usbfwData.ep0Status = EP_STALL;
- break;
- }
- }
- return TRUE;
- }
- void usbsrClearFeature()
- {
- if (!ChangeFeature(FALSE)) {
- usbsrHookClearFeature();
- }
- }
- void usbsrSetFeature(void)
- {
- if (!ChangeFeature(TRUE)) {
- usbsrHookSetFeature();
- }
- }
- void usbsrSetAddress(void)
- {
-
- if (usbSetupHeader.index || usbSetupHeader.length || HI_UINT16(usbSetupHeader.value) || (LO_UINT16(usbSetupHeader.value) & 0x80)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- USBADDR = LO_UINT16(usbSetupHeader.value);
- if (LO_UINT16(usbSetupHeader.value) != 0) {
- if (usbfwData.usbState == DEV_DEFAULT) usbfwData.usbState = DEV_ADDRESS;
- } else {
- if (usbfwData.usbState == DEV_ADDRESS) usbfwData.usbState = DEV_DEFAULT;
- }
- }
- }
- void usbsrGetDescriptor(void)
- {
- uint8 n;
-
- switch (HI_UINT16(usbSetupHeader.value)) {
-
- case DESC_TYPE_DEVICE:
- usbSetupData.pBuffer = (uint8 __code*) usbdpGetDeviceDesc();
- usbSetupData.bytesLeft = usbSetupData.pBuffer[DESC_LENGTH_IDX];
- break;
-
- case DESC_TYPE_CONFIG:
- usbSetupData.pBuffer = (uint8 __code*) usbdpGetConfigurationDesc(0, LO_UINT16(usbSetupHeader.value));
- usbSetupData.bytesLeft = usbSetupData.pBuffer[DESC_CONFIG_LENGTH_LSB_IDX] +
- usbSetupData.pBuffer[DESC_CONFIG_LENGTH_MSB_IDX] * 256;
- break;
-
- case DESC_TYPE_STRING:
-
- usbSetupData.pBuffer = (uint8 *)usbdpGetStringDesc(LO_UINT16(usbSetupHeader.value));
- usbSetupData.bytesLeft = usbSetupData.pBuffer[DESC_LENGTH_IDX];
- break;
-
- default:
-
- usbSetupData.pBuffer = NULL;
- for (n = 0; n < ((uint16)usbDescriptorMarker.pUsbDescLutEnd - (uint16)usbDescriptorMarker.pUsbDescLut) / sizeof(DESC_LUT_INFO); n++) {
- if ((usbDescriptorMarker.pUsbDescLut[n].valueMsb == HI_UINT16(usbSetupHeader.value))
- && (usbDescriptorMarker.pUsbDescLut[n].valueLsb == LO_UINT16(usbSetupHeader.value))
- && (usbDescriptorMarker.pUsbDescLut[n].indexMsb == HI_UINT16(usbSetupHeader.index))
- && (usbDescriptorMarker.pUsbDescLut[n].indexLsb == LO_UINT16(usbSetupHeader.index)) )
- {
- usbSetupData.pBuffer = usbDescriptorMarker.pUsbDescLut[n].pDescStart;
- usbSetupData.bytesLeft = usbDescriptorMarker.pUsbDescLut[n].length;
- }
- }
- }
-
- if (usbSetupData.pBuffer == NULL) usbfwData.ep0Status = EP_STALL;
- if (usbfwData.ep0Status != EP_STALL) {
-
-
- if (usbSetupData.bytesLeft > usbSetupHeader.length) {
- usbSetupData.bytesLeft = usbSetupHeader.length;
- }
- usbfwData.ep0Status = EP_TX;
- }
- }
- static void ConfigureEndpoints(USB_INTERFACE_DESCRIPTOR __code *pInterface)
- {
- uint8 n;
- uint16 maxpRegValue;
- uint8 csRegValue;
- uint8 endpoint;
- USB_ENDPOINT_DESCRIPTOR __code *pEndpoint;
- DBLBUF_LUT_INFO __code *pUsbDblbufLutInfo;
-
- if (pInterface->bNumEndpoints) {
- pUsbDblbufLutInfo = (DBLBUF_LUT_INFO __code*) usbDescriptorMarker.pUsbDblbufLut;
- while (pUsbDblbufLutInfo->pInterface != pInterface) {
- pUsbDblbufLutInfo++;
- }
- }
-
- for (n = 0; n < pInterface->bNumEndpoints; n++) {
- if (pEndpoint = usbdpFindNext(DESC_TYPE_ENDPOINT, 0)) {
-
- endpoint = pEndpoint->bEndpointAddress & 0x0F;
- USBFW_SELECT_ENDPOINT(endpoint);
- csRegValue = 0x00;
- maxpRegValue = (pEndpoint->wMaxPacketSize + 7) >> 3;
-
- if (pEndpoint->bEndpointAddress & 0x80) {
-
- USBCSIL = USBCSIL_CLR_DATA_TOG | USBCSIL_FLUSH_PACKET;
- USBCSIL = USBCSIL_FLUSH_PACKET;
-
- if ((pEndpoint->bmAttributes & EP_ATTR_TYPE_BM) == EP_ATTR_ISO) csRegValue |= USBCSIH_ISO;
- if (pUsbDblbufLutInfo->inMask & (1 << endpoint)) csRegValue |= USBCSIH_IN_DBL_BUF;
- USBCSIH = csRegValue;
-
- USBMAXI = maxpRegValue;
-
- usbfwData.pEpInStatus[endpoint - 1] = EP_IDLE;
-
- } else {
-
- USBCSOL = USBCSOL_CLR_DATA_TOG | USBCSOL_FLUSH_PACKET;
- USBCSOL = USBCSOL_FLUSH_PACKET;
-
- if ((pEndpoint->bmAttributes & EP_ATTR_TYPE_BM) == EP_ATTR_ISO) csRegValue |= USBCSOH_ISO;
- if (pUsbDblbufLutInfo->outMask & (1 << endpoint)) csRegValue |= USBCSOH_OUT_DBL_BUF;
- USBCSOH = csRegValue;
-
- USBMAXO = maxpRegValue;
-
- usbfwData.pEpOutStatus[endpoint - 1] = EP_IDLE;
- }
- USBFW_SELECT_ENDPOINT(0);
- }
- }
- }
- void usbsrGetConfiguration(void)
- {
-
- if (usbSetupHeader.value || usbSetupHeader.index || (usbSetupHeader.length != 1)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- usbSetupData.pBuffer = &usbfwData.configurationValue;
- usbSetupData.bytesLeft = 1;
- usbfwData.ep0Status = EP_TX;
- }
- }
- void usbsrSetConfiguration(void)
- {
- uint8 n;
- USB_CONFIGURATION_DESCRIPTOR __code *pConfiguration;
- USB_INTERFACE_DESCRIPTOR __code *pInterface;
-
- if ((usbfwData.usbState == DEV_DEFAULT) || usbSetupHeader.index || usbSetupHeader.length || HI_UINT16(usbSetupHeader.value)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- usbsrHookProcessEvent(USBSR_EVENT_CONFIGURATION_CHANGING, 0);
-
- if (LO_UINT16(usbSetupHeader.value)) {
-
- pConfiguration = usbdpGetConfigurationDesc(LO_UINT16(usbSetupHeader.value), 0);
-
- if (pConfiguration) {
- usbfwData.usbState = DEV_CONFIGURED;
- usbfwData.configurationValue = LO_UINT16(usbSetupHeader.value);
-
- for (n = 0; n < pConfiguration->bNumInterfaces; n++) {
- usbfwData.pAlternateSetting[n] = 0x00;
-
- do {
- pInterface = usbdpFindNext(DESC_TYPE_INTERFACE, 0);
- } while (pInterface->bAlternateSetting != usbfwData.pAlternateSetting[n]);
-
- ConfigureEndpoints(pInterface);
- }
-
- } else {
- usbfwData.ep0Status = EP_STALL;
- }
-
- } else {
- usbfwData.configurationValue = LO_UINT16(usbSetupHeader.value);
- usbfwData.usbState = DEV_ADDRESS;
- usbfwSetAllEpStatus(EP_HALT);
- }
- usbsrHookProcessEvent(USBSR_EVENT_CONFIGURATION_CHANGED, 0);
- }
- }
- void usbsrGetInterface(void)
- {
-
- if ((usbfwData.usbState != DEV_CONFIGURED) || (usbSetupHeader.requestType != RT_IN_INTERFACE) || usbSetupHeader.value || (usbSetupHeader.length != 1)) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- usbSetupData.pBuffer = &usbfwData.pAlternateSetting[usbSetupHeader.index];
- usbSetupData.bytesLeft = 1;
- usbfwData.ep0Status = EP_TX;
- }
- }
- void usbsrSetInterface(void)
- {
- USB_INTERFACE_DESCRIPTOR __code *pInterface;
-
- if ((usbfwData.usbState != DEV_CONFIGURED) || (usbSetupHeader.requestType != RT_OUT_INTERFACE) || usbSetupHeader.length) {
- usbfwData.ep0Status = EP_STALL;
-
- } else {
- if (pInterface = usbdpGetInterfaceDesc(usbfwData.configurationValue, usbSetupHeader.index, usbSetupHeader.value)) {
- usbsrHookProcessEvent(USBSR_EVENT_INTERFACE_CHANGING, usbSetupHeader.index);
- usbfwData.pAlternateSetting[usbSetupHeader.index] = usbSetupHeader.value;
-
- ConfigureEndpoints(pInterface);
- usbsrHookProcessEvent(USBSR_EVENT_INTERFACE_CHANGED, usbSetupHeader.index);
-
- } else {
- usbfwData.ep0Status = EP_STALL;
- }
- }
- }
|