BLE demo for mbed Ported RunningElectronics's SBDBT firmware for BLE. It can communicate with iOS

Dependencies:   FatFileSystem mbed

Fork of BTstack by Norimasa Okamoto

Committer:
todotani
Date:
Wed Feb 20 14:18:38 2013 +0000
Revision:
6:cf06ba884429
Parent:
0:1ed23ab1345f
Change tick timer to 1ms. Change attribute 0xFFF1 as read of DigitalIn p5

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:1ed23ab1345f 1 #include "UsbDevice.h"
va009039 0:1ed23ab1345f 2 //#define __DEBUG
va009039 0:1ed23ab1345f 3 #include "mydbg.h"
va009039 0:1ed23ab1345f 4
va009039 0:1ed23ab1345f 5 #define PORT_RESET 4
va009039 0:1ed23ab1345f 6 #define PORT_POWER 8
va009039 0:1ed23ab1345f 7 #define C_PORT_CONNECTION 16
va009039 0:1ed23ab1345f 8 #define C_PORT_RESET 20
va009039 0:1ed23ab1345f 9
va009039 0:1ed23ab1345f 10 UsbErr UsbDevice::hub_init()
va009039 0:1ed23ab1345f 11 {
va009039 0:1ed23ab1345f 12 UsbErr rc;
va009039 0:1ed23ab1345f 13 uint8_t buf[9];
va009039 0:1ed23ab1345f 14 rc = controlReceive(
va009039 0:1ed23ab1345f 15 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_DEVICE, // 0xa0
va009039 0:1ed23ab1345f 16 GET_DESCRIPTOR,
va009039 0:1ed23ab1345f 17 (USB_DESCRIPTOR_TYPE_HUB << 8), 0, buf, sizeof(buf));
va009039 0:1ed23ab1345f 18 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 19 DBG_ASSERT(buf[0] == 9);
va009039 0:1ed23ab1345f 20 DBG_ASSERT(buf[1] == 0x29);
va009039 0:1ed23ab1345f 21 DBG_BYTES("HUB DESCRIPTOR", buf, sizeof(buf));
va009039 0:1ed23ab1345f 22
va009039 0:1ed23ab1345f 23 m_hub_ports = buf[2];
va009039 0:1ed23ab1345f 24 VERBOSE("NbrPorts: %d\n", m_hub_ports);
va009039 0:1ed23ab1345f 25 int PwrOn2PwrGood = buf[5];
va009039 0:1ed23ab1345f 26 VERBOSE("PwrOn2PwrGood: %d %d ms\n", PwrOn2PwrGood, PwrOn2PwrGood*2);
va009039 0:1ed23ab1345f 27 VERBOSE("HubContrCurrent: %d\n", buf[6]);
va009039 0:1ed23ab1345f 28
va009039 0:1ed23ab1345f 29 rc = setConfiguration(1);
va009039 0:1ed23ab1345f 30 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 31
va009039 0:1ed23ab1345f 32 uint8_t status[4];
va009039 0:1ed23ab1345f 33 rc = controlReceive(
va009039 0:1ed23ab1345f 34 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_DEVICE, // 0xa0
va009039 0:1ed23ab1345f 35 GET_STATUS,
va009039 0:1ed23ab1345f 36 0, 0, status, sizeof(status));
va009039 0:1ed23ab1345f 37 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 38 DBG_BYTES("HUB STATUS", status, sizeof(status));
va009039 0:1ed23ab1345f 39
va009039 0:1ed23ab1345f 40 for(int i = 1; i <= m_hub_ports; i++) {
va009039 0:1ed23ab1345f 41 rc = SetPortFeature(PORT_POWER, i);
va009039 0:1ed23ab1345f 42 DBG("PORT_POWER port=%d rc=%d\n", i, rc);
va009039 0:1ed23ab1345f 43 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 44 if (rc != USBERR_OK) {
va009039 0:1ed23ab1345f 45 return rc;
va009039 0:1ed23ab1345f 46 }
va009039 0:1ed23ab1345f 47 }
va009039 0:1ed23ab1345f 48 wait_ms(PwrOn2PwrGood*2);
va009039 0:1ed23ab1345f 49
va009039 0:1ed23ab1345f 50 m_enumerated = true;
va009039 0:1ed23ab1345f 51 return USBERR_OK;
va009039 0:1ed23ab1345f 52 }
va009039 0:1ed23ab1345f 53
va009039 0:1ed23ab1345f 54 UsbErr UsbDevice::hub_poll()
va009039 0:1ed23ab1345f 55 {
va009039 0:1ed23ab1345f 56 DBG("%p m_hub=%d m_port=%d m_addr=%d\n", this, m_hub, m_port, m_addr);
va009039 0:1ed23ab1345f 57 // check status
va009039 0:1ed23ab1345f 58 for(int port = 1; port <= m_hub_ports; port++) {
va009039 0:1ed23ab1345f 59 uint8_t status[4];
va009039 0:1ed23ab1345f 60 UsbErr rc = GetPortStatus(port, status, sizeof(status));
va009039 0:1ed23ab1345f 61 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 62 DBG("port=%d\n", port);
va009039 0:1ed23ab1345f 63 DBG_BYTES("STATUS", status, sizeof(status));
va009039 0:1ed23ab1345f 64 if (status[2] & 0x01) { // Connect Status Change, has changed
va009039 0:1ed23ab1345f 65 DBG_ASSERT(status[0] & 0x01);
va009039 0:1ed23ab1345f 66 ClearPortFeature(C_PORT_CONNECTION, port);
va009039 0:1ed23ab1345f 67 DBG_ASSERT(m_pMgr);
va009039 0:1ed23ab1345f 68 m_pMgr->onUsbDeviceConnected(m_addr, port);
va009039 0:1ed23ab1345f 69 return USBERR_PROCESSING;
va009039 0:1ed23ab1345f 70 }
va009039 0:1ed23ab1345f 71 }
va009039 0:1ed23ab1345f 72 return USBERR_OK;
va009039 0:1ed23ab1345f 73 }
va009039 0:1ed23ab1345f 74
va009039 0:1ed23ab1345f 75 UsbErr UsbDevice::hub_PortReset(int port)
va009039 0:1ed23ab1345f 76 {
va009039 0:1ed23ab1345f 77 DBG("%p port=%d\n", this, port);
va009039 0:1ed23ab1345f 78 DBG_ASSERT(port >= 1);
va009039 0:1ed23ab1345f 79 SetPortReset(port);
va009039 0:1ed23ab1345f 80 // wait reset
va009039 0:1ed23ab1345f 81 for(int i = 0; i < 100; i++) {
va009039 0:1ed23ab1345f 82 uint8_t status[4];
va009039 0:1ed23ab1345f 83 UsbErr rc = GetPortStatus(port, status, sizeof(status));
va009039 0:1ed23ab1345f 84 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 85 DBG_BYTES("RESET", status, sizeof(status));
va009039 0:1ed23ab1345f 86 if (status[2] & 0x10) { // Reset change , Reset complete
va009039 0:1ed23ab1345f 87 return USBERR_OK;
va009039 0:1ed23ab1345f 88 }
va009039 0:1ed23ab1345f 89 wait_ms(5);
va009039 0:1ed23ab1345f 90 }
va009039 0:1ed23ab1345f 91 return USBERR_ERROR;
va009039 0:1ed23ab1345f 92 }
va009039 0:1ed23ab1345f 93
va009039 0:1ed23ab1345f 94 UsbErr UsbDevice::SetPortFeature(int feature, int index)
va009039 0:1ed23ab1345f 95 {
va009039 0:1ed23ab1345f 96 //DBG("feature=%d index=%d\n", feature, index);
va009039 0:1ed23ab1345f 97 UsbErr rc;
va009039 0:1ed23ab1345f 98 rc = controlSend(
va009039 0:1ed23ab1345f 99 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_OTHER,
va009039 0:1ed23ab1345f 100 SET_FEATURE, feature, index, 0, 0);
va009039 0:1ed23ab1345f 101 return rc;
va009039 0:1ed23ab1345f 102 }
va009039 0:1ed23ab1345f 103
va009039 0:1ed23ab1345f 104 UsbErr UsbDevice::ClearPortFeature(int feature, int index)
va009039 0:1ed23ab1345f 105 {
va009039 0:1ed23ab1345f 106 UsbErr rc;
va009039 0:1ed23ab1345f 107 rc = controlSend(
va009039 0:1ed23ab1345f 108 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_OTHER,
va009039 0:1ed23ab1345f 109 CLEAR_FEATURE, feature, index, 0, 0);
va009039 0:1ed23ab1345f 110 return rc;
va009039 0:1ed23ab1345f 111 }
va009039 0:1ed23ab1345f 112
va009039 0:1ed23ab1345f 113 UsbErr UsbDevice::SetPortReset(int port)
va009039 0:1ed23ab1345f 114 {
va009039 0:1ed23ab1345f 115 //DBG("port=%d\n", port);
va009039 0:1ed23ab1345f 116 UsbErr rc = SetPortFeature(PORT_RESET, port);
va009039 0:1ed23ab1345f 117 DBG_ASSERT(rc == USBERR_OK);
va009039 0:1ed23ab1345f 118 return rc;
va009039 0:1ed23ab1345f 119 }
va009039 0:1ed23ab1345f 120
va009039 0:1ed23ab1345f 121 UsbErr UsbDevice::GetPortStatus(int port, uint8_t* buf, int size)
va009039 0:1ed23ab1345f 122 {
va009039 0:1ed23ab1345f 123 DBG_ASSERT(size == 4);
va009039 0:1ed23ab1345f 124 UsbErr rc;
va009039 0:1ed23ab1345f 125 //return USBControlTransfer(device,
va009039 0:1ed23ab1345f 126 //DEVICE_TO_HOST | REQUEST_TYPE_CLASS | RECIPIENT_OTHER,
va009039 0:1ed23ab1345f 127 //GET_STATUS,0,port,(u8*)status,4);
va009039 0:1ed23ab1345f 128
va009039 0:1ed23ab1345f 129 rc = controlReceive(
va009039 0:1ed23ab1345f 130 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_OTHER,
va009039 0:1ed23ab1345f 131 GET_STATUS, 0, port, buf, sizeof(buf));
va009039 0:1ed23ab1345f 132 return rc;
va009039 0:1ed23ab1345f 133 }