Norimasa Okamoto / Mbed 2 deprecated F401RE-BTstack_example

BTstack for Nucleo F401RE/FRDM-KL46Z example program

Dependencies:   F401RE-USBHost mbed

The usage is the same as KL46Z-BTstack_example.
使い方はKL46Z-BTstack_exampleと同じです。
/media/uploads/va009039/f401re-btstack.jpg

KL46Z-USBHostBTstack/USBHostBTstack.cpp@0:a05a07cd6fdf, 2014-06-09 (annotated)

Committer:
va009039
Date:
Mon Jun 09 09:03:25 2014 +0000
Revision:
0:a05a07cd6fdf
first commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:a05a07cd6fdf 1 // USBHostBTstack.cpp
va009039 0:a05a07cd6fdf 2 #include "USBHostBTstack.h"
va009039 0:a05a07cd6fdf 3
va009039 0:a05a07cd6fdf 4 //#define BTSTACK_DEBUG
va009039 0:a05a07cd6fdf 5
va009039 0:a05a07cd6fdf 6 #ifdef BTSTACK_DEBUG
va009039 0:a05a07cd6fdf 7 #define BT_DBG(x, ...) std::printf("[%s:%d]"x"\r\n", __PRETTY_FUNCTION__, __LINE__, ##__VA_ARGS__);
va009039 0:a05a07cd6fdf 8 #define BT_DBG_BYTES(STR,BUF,LEN) _debug_bytes(__PRETTY_FUNCTION__,__LINE__,STR,BUF,LEN)
va009039 0:a05a07cd6fdf 9 #else
va009039 0:a05a07cd6fdf 10 #define BT_DBG(...) while(0);
va009039 0:a05a07cd6fdf 11 #define BT_DBG_BYTES(S,BUF,LEN) while(0);
va009039 0:a05a07cd6fdf 12 #endif
va009039 0:a05a07cd6fdf 13 #define USB_INFO(...) do{fprintf(stderr,__VA_ARGS__);fprintf(stderr,"\r\n");}while(0);
va009039 0:a05a07cd6fdf 14
va009039 0:a05a07cd6fdf 15 #define HCI_COMMAND_DATA_PACKET 0x01
va009039 0:a05a07cd6fdf 16 #define HCI_ACL_DATA_PACKET 0x02
va009039 0:a05a07cd6fdf 17 #define HCI_SCO_DATA_PACKET 0x03
va009039 0:a05a07cd6fdf 18 #define HCI_EVENT_PACKET 0x04
va009039 0:a05a07cd6fdf 19
va009039 0:a05a07cd6fdf 20 USBHostBTstack::USBHostBTstack()
va009039 0:a05a07cd6fdf 21 {
va009039 0:a05a07cd6fdf 22 host = USBHost::getHostInst();
va009039 0:a05a07cd6fdf 23 init();
va009039 0:a05a07cd6fdf 24 m_pCb = NULL;
va009039 0:a05a07cd6fdf 25 }
va009039 0:a05a07cd6fdf 26
va009039 0:a05a07cd6fdf 27 void USBHostBTstack::init()
va009039 0:a05a07cd6fdf 28 {
va009039 0:a05a07cd6fdf 29 BT_DBG("");
va009039 0:a05a07cd6fdf 30 dev = NULL;
va009039 0:a05a07cd6fdf 31 int_in = NULL;
va009039 0:a05a07cd6fdf 32 bulk_in = NULL;
va009039 0:a05a07cd6fdf 33 bulk_out = NULL;
va009039 0:a05a07cd6fdf 34 btstack_intf = -1;
va009039 0:a05a07cd6fdf 35 btstack_device_found = false;
va009039 0:a05a07cd6fdf 36 dev_connected = false;
va009039 0:a05a07cd6fdf 37 ep_int_in = false;
va009039 0:a05a07cd6fdf 38 ep_bulk_in = false;
va009039 0:a05a07cd6fdf 39 ep_bulk_out = false;
va009039 0:a05a07cd6fdf 40 }
va009039 0:a05a07cd6fdf 41
va009039 0:a05a07cd6fdf 42 bool USBHostBTstack::connected()
va009039 0:a05a07cd6fdf 43 {
va009039 0:a05a07cd6fdf 44 return dev_connected;
va009039 0:a05a07cd6fdf 45 }
va009039 0:a05a07cd6fdf 46
va009039 0:a05a07cd6fdf 47 bool USBHostBTstack::connect()
va009039 0:a05a07cd6fdf 48 {
va009039 0:a05a07cd6fdf 49 if (dev_connected) {
va009039 0:a05a07cd6fdf 50 return true;
va009039 0:a05a07cd6fdf 51 }
va009039 0:a05a07cd6fdf 52
va009039 0:a05a07cd6fdf 53 for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
va009039 0:a05a07cd6fdf 54 if ((dev = host->getDevice(i)) != NULL) {
va009039 0:a05a07cd6fdf 55
va009039 0:a05a07cd6fdf 56 BT_DBG("Trying to connect BTstack device\r\n");
va009039 0:a05a07cd6fdf 57
va009039 0:a05a07cd6fdf 58 if(host->enumerate(dev, this)) {
va009039 0:a05a07cd6fdf 59 break;
va009039 0:a05a07cd6fdf 60 }
va009039 0:a05a07cd6fdf 61 if (btstack_device_found) {
va009039 0:a05a07cd6fdf 62 int_in = dev->getEndpoint(btstack_intf, INTERRUPT_ENDPOINT, IN);
va009039 0:a05a07cd6fdf 63 bulk_in = dev->getEndpoint(btstack_intf, BULK_ENDPOINT, IN);
va009039 0:a05a07cd6fdf 64 bulk_out = dev->getEndpoint(btstack_intf, BULK_ENDPOINT, OUT);
va009039 0:a05a07cd6fdf 65 if (!int_in || !bulk_in || !bulk_out) {
va009039 0:a05a07cd6fdf 66 continue;
va009039 0:a05a07cd6fdf 67 }
va009039 0:a05a07cd6fdf 68 USB_INFO("New BTstack device: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, btstack_intf);
va009039 0:a05a07cd6fdf 69 //dev->setName("BTstack", btstack_intf);
va009039 0:a05a07cd6fdf 70 //host->registerDriver(dev, btstack_intf, this, &USBHostBTstack::init);
va009039 0:a05a07cd6fdf 71
va009039 0:a05a07cd6fdf 72 //int_in->attach(this, &USBHostBTstack::int_rxHandler);
va009039 0:a05a07cd6fdf 73 //host->interruptRead(dev, int_in, int_report, int_in->getSize(), false);
va009039 0:a05a07cd6fdf 74
va009039 0:a05a07cd6fdf 75 //bulk_in->attach(this, &USBHostBTstack::bulk_rxHandler);
va009039 0:a05a07cd6fdf 76 //host->bulkRead(dev, bulk_in, bulk_report, bulk_in->getSize(), false);
va009039 0:a05a07cd6fdf 77
va009039 0:a05a07cd6fdf 78 dev_connected = true;
va009039 0:a05a07cd6fdf 79 return true;
va009039 0:a05a07cd6fdf 80 }
va009039 0:a05a07cd6fdf 81 }
va009039 0:a05a07cd6fdf 82 }
va009039 0:a05a07cd6fdf 83 init();
va009039 0:a05a07cd6fdf 84 return false;
va009039 0:a05a07cd6fdf 85 }
va009039 0:a05a07cd6fdf 86
va009039 0:a05a07cd6fdf 87 /*virtual*/ void USBHostBTstack::setVidPid(uint16_t vid, uint16_t pid)
va009039 0:a05a07cd6fdf 88 {
va009039 0:a05a07cd6fdf 89 BT_DBG("vid:%04x,pid:%04x", vid, pid);
va009039 0:a05a07cd6fdf 90 }
va009039 0:a05a07cd6fdf 91
va009039 0:a05a07cd6fdf 92 /*virtual*/ bool USBHostBTstack::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
va009039 0:a05a07cd6fdf 93 {
va009039 0:a05a07cd6fdf 94 BT_DBG("intf_nb=%d,intf_class=%02X,intf_subclass=%d,intf_protocol=%d", intf_nb, intf_class, intf_subclass, intf_protocol);
va009039 0:a05a07cd6fdf 95 if ((btstack_intf == -1) && intf_class == 0xe0) {
va009039 0:a05a07cd6fdf 96 btstack_intf = intf_nb;
va009039 0:a05a07cd6fdf 97 return true;
va009039 0:a05a07cd6fdf 98 }
va009039 0:a05a07cd6fdf 99 return false;
va009039 0:a05a07cd6fdf 100 }
va009039 0:a05a07cd6fdf 101
va009039 0:a05a07cd6fdf 102 /*virtual*/ bool USBHostBTstack::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
va009039 0:a05a07cd6fdf 103 {
va009039 0:a05a07cd6fdf 104 BT_DBG("intf_nb:%d,type:%d,dir:%d",intf_nb, type, dir);
va009039 0:a05a07cd6fdf 105 if (intf_nb == btstack_intf) {
va009039 0:a05a07cd6fdf 106 if (ep_int_in == false && type == INTERRUPT_ENDPOINT && dir == IN) {
va009039 0:a05a07cd6fdf 107 ep_int_in = true;
va009039 0:a05a07cd6fdf 108 } else if (ep_bulk_in == false && type == BULK_ENDPOINT && dir == IN) {
va009039 0:a05a07cd6fdf 109 ep_bulk_in = true;
va009039 0:a05a07cd6fdf 110 } else if (ep_bulk_out == false && type == BULK_ENDPOINT && dir == OUT) {
va009039 0:a05a07cd6fdf 111 ep_bulk_out = true;
va009039 0:a05a07cd6fdf 112 } else {
va009039 0:a05a07cd6fdf 113 return false;
va009039 0:a05a07cd6fdf 114 }
va009039 0:a05a07cd6fdf 115 if (ep_int_in && ep_bulk_in && ep_bulk_out) {
va009039 0:a05a07cd6fdf 116 btstack_device_found = true;
va009039 0:a05a07cd6fdf 117 }
va009039 0:a05a07cd6fdf 118 return true;
va009039 0:a05a07cd6fdf 119 }
va009039 0:a05a07cd6fdf 120 return false;
va009039 0:a05a07cd6fdf 121 }
va009039 0:a05a07cd6fdf 122
va009039 0:a05a07cd6fdf 123 int USBHostBTstack::open()
va009039 0:a05a07cd6fdf 124 {
va009039 0:a05a07cd6fdf 125 BT_DBG("%p", this);
va009039 0:a05a07cd6fdf 126 if (!connect()) {
va009039 0:a05a07cd6fdf 127 error("Bluetooth not found.\n");
va009039 0:a05a07cd6fdf 128 }
va009039 0:a05a07cd6fdf 129 return 0;
va009039 0:a05a07cd6fdf 130 }
va009039 0:a05a07cd6fdf 131
va009039 0:a05a07cd6fdf 132 int USBHostBTstack::send_packet(uint8_t packet_type, uint8_t* packet, int size)
va009039 0:a05a07cd6fdf 133 {
va009039 0:a05a07cd6fdf 134 USB_TYPE res;
va009039 0:a05a07cd6fdf 135 switch(packet_type){
va009039 0:a05a07cd6fdf 136 case HCI_COMMAND_DATA_PACKET:
va009039 0:a05a07cd6fdf 137 BT_DBG_BYTES("HCI_CMD:", packet, size);
va009039 0:a05a07cd6fdf 138 res = host->controlWrite(dev,
va009039 0:a05a07cd6fdf 139 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_DEVICE,
va009039 0:a05a07cd6fdf 140 0, 0, 0, packet, size);
va009039 0:a05a07cd6fdf 141 TEST_ASSERT(res == USB_TYPE_OK);
va009039 0:a05a07cd6fdf 142 break;
va009039 0:a05a07cd6fdf 143 case HCI_ACL_DATA_PACKET:
va009039 0:a05a07cd6fdf 144 BT_DBG_BYTES("ACL_SND:", packet, size);
va009039 0:a05a07cd6fdf 145 res = host->bulkWrite(dev, bulk_out, packet, size);
va009039 0:a05a07cd6fdf 146 TEST_ASSERT(res == USB_TYPE_OK);
va009039 0:a05a07cd6fdf 147 break;
va009039 0:a05a07cd6fdf 148 default:
va009039 0:a05a07cd6fdf 149 TEST_ASSERT(0);
va009039 0:a05a07cd6fdf 150 }
va009039 0:a05a07cd6fdf 151 return 0;
va009039 0:a05a07cd6fdf 152 }
va009039 0:a05a07cd6fdf 153
va009039 0:a05a07cd6fdf 154 void USBHostBTstack::register_packet_handler(void (*pMethod)(uint8_t, uint8_t*, uint16_t) )
va009039 0:a05a07cd6fdf 155 {
va009039 0:a05a07cd6fdf 156 BT_DBG("pMethod: %p", pMethod);
va009039 0:a05a07cd6fdf 157 m_pCb = pMethod;
va009039 0:a05a07cd6fdf 158 }
va009039 0:a05a07cd6fdf 159
va009039 0:a05a07cd6fdf 160 void USBHostBTstack::poll()
va009039 0:a05a07cd6fdf 161 {
va009039 0:a05a07cd6fdf 162 int result = host->interruptReadNB(int_in, int_report, sizeof(int_report));
va009039 0:a05a07cd6fdf 163 if (result >= 0) {
va009039 0:a05a07cd6fdf 164 int len = int_in->getLengthTransferred();
va009039 0:a05a07cd6fdf 165 BT_DBG_BYTES("HCI_EVT:", int_report, len);
va009039 0:a05a07cd6fdf 166 if (m_pCb) {
va009039 0:a05a07cd6fdf 167 m_pCb(HCI_EVENT_PACKET, int_report, len);
va009039 0:a05a07cd6fdf 168 }
va009039 0:a05a07cd6fdf 169 }
va009039 0:a05a07cd6fdf 170 result = host->bulkReadNB(bulk_in, bulk_report, sizeof(bulk_report));
va009039 0:a05a07cd6fdf 171 if (result >= 0) {
va009039 0:a05a07cd6fdf 172 int len = bulk_in->getLengthTransferred();
va009039 0:a05a07cd6fdf 173 BT_DBG_BYTES("HCI_ACL_RECV:", bulk_report, len);
va009039 0:a05a07cd6fdf 174 if (m_pCb) {
va009039 0:a05a07cd6fdf 175 m_pCb(HCI_ACL_DATA_PACKET, bulk_report, len);
va009039 0:a05a07cd6fdf 176 }
va009039 0:a05a07cd6fdf 177 }
va009039 0:a05a07cd6fdf 178 }
va009039 0:a05a07cd6fdf 179
va009039 0:a05a07cd6fdf 180 void _debug_bytes(const char* pretty, int line, const char* s, uint8_t* buf, int len)
va009039 0:a05a07cd6fdf 181 {
va009039 0:a05a07cd6fdf 182 printf("[%s:%d]\n%s", pretty, line, s);
va009039 0:a05a07cd6fdf 183 for(int i = 0; i < len; i++) {
va009039 0:a05a07cd6fdf 184 printf(" %02x", buf[i]);
va009039 0:a05a07cd6fdf 185 }
va009039 0:a05a07cd6fdf 186 printf("\n");
va009039 0:a05a07cd6fdf 187 }