[337] | 1 | /*
|
---|
| 2 | * Copyright (C) 2014 BlueKitchen GmbH
|
---|
| 3 | *
|
---|
| 4 | * Redistribution and use in source and binary forms, with or without
|
---|
| 5 | * modification, are permitted provided that the following conditions
|
---|
| 6 | * are met:
|
---|
| 7 | *
|
---|
| 8 | * 1. Redistributions of source code must retain the above copyright
|
---|
| 9 | * notice, this list of conditions and the following disclaimer.
|
---|
| 10 | * 2. Redistributions in binary form must reproduce the above copyright
|
---|
| 11 | * notice, this list of conditions and the following disclaimer in the
|
---|
| 12 | * documentation and/or other materials provided with the distribution.
|
---|
| 13 | * 3. Neither the name of the copyright holders nor the names of
|
---|
| 14 | * contributors may be used to endorse or promote products derived
|
---|
| 15 | * from this software without specific prior written permission.
|
---|
| 16 | * 4. Any redistribution, use, or modification is done solely for
|
---|
| 17 | * personal benefit and not for any commercial purpose or for
|
---|
| 18 | * monetary gain.
|
---|
| 19 | *
|
---|
| 20 | * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
---|
| 21 | * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
---|
| 22 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
---|
| 23 | * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
---|
| 24 | * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
---|
| 25 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
---|
| 26 | * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
---|
| 27 | * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
---|
| 28 | * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
---|
| 29 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
---|
| 30 | * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
---|
| 31 | * SUCH DAMAGE.
|
---|
| 32 | *
|
---|
| 33 | * Please inquire about commercial licensing options at
|
---|
| 34 | * contact@bluekitchen-gmbh.com
|
---|
| 35 | *
|
---|
| 36 | */
|
---|
| 37 |
|
---|
| 38 | #include "btstack-config.h"
|
---|
| 39 |
|
---|
| 40 | #include <stdint.h>
|
---|
| 41 |
|
---|
| 42 | #include <btstack/hci_cmds.h>
|
---|
| 43 | #include <btstack/run_loop.h>
|
---|
| 44 | #include <btstack/sdp_util.h>
|
---|
| 45 |
|
---|
| 46 | #include <kernel.h>
|
---|
| 47 | #include "kernel_cfg.h"
|
---|
| 48 | #include "target_syssvc.h"
|
---|
| 49 |
|
---|
| 50 | #include "debug.h"
|
---|
| 51 | #include "hci.h"
|
---|
| 52 | #include "btstack_memory.h"
|
---|
| 53 | #include "hci_dump.h"
|
---|
| 54 | #include "l2cap.h"
|
---|
| 55 | #include "sdp_parser.h"
|
---|
| 56 | #include "sdp_client.h"
|
---|
| 57 | #include "sdp_query_util.h"
|
---|
| 58 | #include "sdp.h"
|
---|
| 59 | #include "pan.h"
|
---|
[374] | 60 | #include "bt_main.h"
|
---|
| 61 | #include "usb_hbth.h"
|
---|
[337] | 62 |
|
---|
| 63 | //#define PACKET_DUMP
|
---|
| 64 |
|
---|
| 65 | // エラー返却用定数(-1:0xffff固定)
|
---|
| 66 | #define FAILED_RFCOMM_ID_NOT_SET 0xffff
|
---|
| 67 |
|
---|
| 68 | #define RFCOMM_SERVER_CHANNEL 1
|
---|
[374] | 69 | static uint16_t rfcomm_channel_id = FAILED_RFCOMM_ID_NOT_SET;
|
---|
[337] | 70 |
|
---|
| 71 | static int record_id = -1;
|
---|
| 72 | static uint16_t bnep_l2cap_psm = 0;
|
---|
| 73 | static uint32_t bnep_remote_uuid = 0;
|
---|
| 74 | static uint16_t bnep_version = 0;
|
---|
| 75 | static uint16_t bnep_cid = 0;
|
---|
| 76 | static bool_t bnep_do_connect = false;
|
---|
| 77 |
|
---|
| 78 | static uint16_t sdp_bnep_l2cap_psm = 0;
|
---|
| 79 | static uint16_t sdp_bnep_version = 0;
|
---|
| 80 | static uint32_t sdp_bnep_remote_uuid = 0;
|
---|
| 81 |
|
---|
| 82 | uint8_t attribute_value[1000];
|
---|
| 83 | const unsigned int attribute_value_buffer_size = sizeof(attribute_value);
|
---|
| 84 |
|
---|
| 85 | extern bd_addr_t remote_addr;
|
---|
| 86 |
|
---|
| 87 | uint8_t spp_service_buffer[120];
|
---|
| 88 | uint8_t bnep_service_buffer[256];
|
---|
| 89 |
|
---|
| 90 | char bt_localname[] = TARGET_NAME"0000";
|
---|
| 91 |
|
---|
| 92 | volatile int bt_bnep_mode = 0;
|
---|
| 93 |
|
---|
[374] | 94 | enum bt_state_t {
|
---|
| 95 | BT_STATE_DORMANT,
|
---|
| 96 | BT_STATE_POWER_ON,
|
---|
| 97 | BT_STATE_BNEP_QUERY,
|
---|
| 98 | BT_STATE_BNEP_WAIT,
|
---|
| 99 | BT_STATE_BNEP_QUERY_WAIT,
|
---|
| 100 | BT_STATE_CONNECTING,
|
---|
| 101 | BT_STATE_CONNECTED,
|
---|
| 102 | };
|
---|
| 103 |
|
---|
| 104 | enum bt_state_t bt_state = BT_STATE_DORMANT;
|
---|
| 105 | int bt_timer;
|
---|
| 106 |
|
---|
[337] | 107 | // outgoing network packet
|
---|
| 108 | const uint8_t * network_buffer;
|
---|
| 109 | uint16_t network_buffer_len;
|
---|
| 110 | uint16_t network_buffer_cid;
|
---|
| 111 |
|
---|
| 112 | /*************** PANU client routines *********************/
|
---|
| 113 |
|
---|
| 114 | char * get_string_from_data_element(uint8_t * element) {
|
---|
| 115 | de_size_t de_size = de_get_size_type(element);
|
---|
| 116 | int pos = de_get_header_size(element);
|
---|
| 117 | int len = 0;
|
---|
| 118 | switch (de_size) {
|
---|
| 119 | case DE_SIZE_VAR_8:
|
---|
| 120 | len = element[1];
|
---|
| 121 | break;
|
---|
| 122 | case DE_SIZE_VAR_16:
|
---|
[374] | 123 | len = big_endian_read_16(element, 1);
|
---|
[337] | 124 | break;
|
---|
| 125 | default:
|
---|
| 126 | break;
|
---|
| 127 | }
|
---|
| 128 | char * str = (char*)malloc(len + 1);
|
---|
| 129 | memcpy(str, &element[pos], len);
|
---|
| 130 | str[len] = '\0';
|
---|
| 131 | return str;
|
---|
| 132 | }
|
---|
| 133 |
|
---|
| 134 | /* @section SDP parser callback
|
---|
| 135 | *
|
---|
| 136 | * @text The SDP parsers retrieves the BNEP PAN UUID as explained in
|
---|
| 137 | * Section [on SDP BNEP Query example](#sec:sdpbnepqueryExample}.
|
---|
| 138 | */
|
---|
| 139 | static void handle_sdp_client_record_complete(void)
|
---|
| 140 | {
|
---|
| 141 | log_info("SDP BNEP Record complete");
|
---|
| 142 |
|
---|
| 143 | // accept first entry or if we foudn a NAP and only have a PANU yet
|
---|
[374] | 144 | if ((bnep_remote_uuid == 0) || (sdp_bnep_remote_uuid == BLUETOOTH_SERVICE_CLASS_NAP && bnep_remote_uuid == BLUETOOTH_SERVICE_CLASS_PANU)) {
|
---|
[337] | 145 | bnep_l2cap_psm = sdp_bnep_l2cap_psm;
|
---|
| 146 | bnep_remote_uuid = sdp_bnep_remote_uuid;
|
---|
| 147 | bnep_version = sdp_bnep_version;
|
---|
| 148 | }
|
---|
| 149 | }
|
---|
| 150 |
|
---|
| 151 | /* SDP parser callback */
|
---|
| 152 | static void handle_sdp_client_query_result(sdp_query_event_t *event)
|
---|
| 153 | {
|
---|
| 154 | sdp_query_attribute_value_event_t *value_event;
|
---|
| 155 | sdp_query_complete_event_t *complete_event;
|
---|
| 156 | des_iterator_t des_list_it;
|
---|
| 157 | des_iterator_t prot_it;
|
---|
| 158 | char *str;
|
---|
| 159 |
|
---|
| 160 | switch (event->type) {
|
---|
[374] | 161 | case SDP_EVENT_QUERY_ATTRIBUTE_VALUE:
|
---|
[337] | 162 | value_event = (sdp_query_attribute_value_event_t*)event;
|
---|
| 163 |
|
---|
| 164 | // Handle new SDP record
|
---|
| 165 | if (value_event->record_id != record_id) {
|
---|
| 166 | handle_sdp_client_record_complete();
|
---|
| 167 | // next record started
|
---|
| 168 | record_id = value_event->record_id;
|
---|
| 169 | log_info("SDP Record: Nr: %d", record_id);
|
---|
| 170 | }
|
---|
| 171 |
|
---|
| 172 | if (value_event->attribute_length <= attribute_value_buffer_size) {
|
---|
| 173 | attribute_value[value_event->data_offset] = value_event->data;
|
---|
| 174 |
|
---|
| 175 | if ((uint16_t)(value_event->data_offset + 1) == value_event->attribute_length) {
|
---|
| 176 | //printf("SDP Attribute Data:");
|
---|
| 177 | //printf_hexdump(attribute_value, value_event->attribute_length);
|
---|
| 178 |
|
---|
| 179 | switch (value_event->attribute_id) {
|
---|
[374] | 180 | case BLUETOOTH_ATTRIBUTE_SERVICE_CLASS_ID_LIST:
|
---|
[337] | 181 | if (de_get_element_type(attribute_value) != DE_DES) break;
|
---|
| 182 | for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) {
|
---|
| 183 | uint8_t * element = des_iterator_get_element(&des_list_it);
|
---|
| 184 | if (de_get_element_type(element) != DE_UUID) continue;
|
---|
| 185 | uint32_t uuid = de_get_uuid32(element);
|
---|
| 186 | switch (uuid) {
|
---|
[374] | 187 | case BLUETOOTH_SERVICE_CLASS_PANU:
|
---|
| 188 | case BLUETOOTH_SERVICE_CLASS_NAP:
|
---|
| 189 | case BLUETOOTH_SERVICE_CLASS_GN:
|
---|
[337] | 190 | log_info("SDP Attribute 0x%04x: BNEP PAN protocol UUID: %04x", value_event->attribute_id, uuid);
|
---|
| 191 | sdp_bnep_remote_uuid = uuid;
|
---|
| 192 | break;
|
---|
| 193 | default:
|
---|
| 194 | log_info("SDP Attribute 0x%04x: UUID: %04x", value_event->attribute_id, uuid);
|
---|
| 195 | break;
|
---|
| 196 | }
|
---|
| 197 | }
|
---|
| 198 | break;
|
---|
| 199 | // 0x0100 "Service Name"
|
---|
| 200 | case 0x0100:
|
---|
| 201 | // 0x0101 "Service Description"
|
---|
| 202 | case 0x0101:
|
---|
| 203 | str = get_string_from_data_element(attribute_value);
|
---|
| 204 | log_info("SDP Attribute: 0x%04x: %s", value_event->attribute_id, str);
|
---|
| 205 | free(str);
|
---|
| 206 | break;
|
---|
[374] | 207 | case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: {
|
---|
[337] | 208 | log_info("SDP Attribute: 0x%04x", value_event->attribute_id);
|
---|
| 209 |
|
---|
| 210 | for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) {
|
---|
| 211 | uint8_t *des_element;
|
---|
| 212 | uint8_t *element;
|
---|
| 213 | uint32_t uuid;
|
---|
| 214 |
|
---|
| 215 | if (des_iterator_get_type(&des_list_it) != DE_DES) continue;
|
---|
| 216 |
|
---|
| 217 | des_element = des_iterator_get_element(&des_list_it);
|
---|
| 218 | des_iterator_init(&prot_it, des_element);
|
---|
| 219 | element = des_iterator_get_element(&prot_it);
|
---|
| 220 |
|
---|
| 221 | if (de_get_element_type(element) != DE_UUID) continue;
|
---|
| 222 |
|
---|
| 223 | uuid = de_get_uuid32(element);
|
---|
| 224 | switch (uuid) {
|
---|
[374] | 225 | case BLUETOOTH_PROTOCOL_L2CAP:
|
---|
[337] | 226 | if (!des_iterator_has_more(&prot_it)) continue;
|
---|
| 227 | des_iterator_next(&prot_it);
|
---|
| 228 | de_element_get_uint16(des_iterator_get_element(&prot_it), &sdp_bnep_l2cap_psm);
|
---|
| 229 | break;
|
---|
[374] | 230 | case BLUETOOTH_PROTOCOL_BNEP:
|
---|
[337] | 231 | if (!des_iterator_has_more(&prot_it)) continue;
|
---|
| 232 | des_iterator_next(&prot_it);
|
---|
| 233 | de_element_get_uint16(des_iterator_get_element(&prot_it), &sdp_bnep_version);
|
---|
| 234 | break;
|
---|
| 235 | default:
|
---|
| 236 | log_info("uuid 0x%04x", uuid);
|
---|
| 237 | break;
|
---|
| 238 | }
|
---|
| 239 | }
|
---|
| 240 | log_info("Summary: uuid 0x%04x, l2cap_psm 0x%04x, bnep_version 0x%04x", sdp_bnep_remote_uuid, sdp_bnep_l2cap_psm, sdp_bnep_version);
|
---|
| 241 | break;
|
---|
| 242 | }
|
---|
| 243 | default:
|
---|
| 244 | break;
|
---|
| 245 | }
|
---|
| 246 | }
|
---|
| 247 | }
|
---|
| 248 | else {
|
---|
| 249 | log_error("SDP attribute value buffer size exceeded: available %d, required %d", attribute_value_buffer_size, value_event->attribute_length);
|
---|
| 250 | }
|
---|
| 251 | break;
|
---|
| 252 |
|
---|
[374] | 253 | case SDP_EVENT_QUERY_COMPLETE:
|
---|
[337] | 254 | handle_sdp_client_record_complete();
|
---|
| 255 | complete_event = (sdp_query_complete_event_t*)event;
|
---|
| 256 | log_error("General query done with status %d, bnep psm %04x.", complete_event->status, bnep_l2cap_psm);
|
---|
| 257 | if (bnep_l2cap_psm) {
|
---|
| 258 | bnep_do_connect = complete_event->status == 0;
|
---|
| 259 | }
|
---|
| 260 | else {
|
---|
[374] | 261 | bnep_do_connect = false;
|
---|
[337] | 262 | log_error("No BNEP service found");
|
---|
| 263 | }
|
---|
[374] | 264 | if (!bnep_do_connect) {
|
---|
| 265 | // 20秒後 BNEP Query 開始
|
---|
| 266 | bt_state = BT_STATE_BNEP_QUERY_WAIT;
|
---|
| 267 | bt_timer = 20 * 1000;
|
---|
| 268 | }
|
---|
[337] | 269 | break;
|
---|
| 270 | }
|
---|
| 271 | }
|
---|
| 272 |
|
---|
| 273 | static void packet_handler(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size)
|
---|
| 274 | {
|
---|
| 275 | uint8_t event;
|
---|
| 276 | bd_addr_t event_addr;
|
---|
| 277 | uint8_t rfcomm_channel_nr;
|
---|
| 278 | uint16_t uuid_source;
|
---|
| 279 | uint16_t uuid_dest;
|
---|
| 280 | uint16_t mtu;
|
---|
| 281 |
|
---|
| 282 | switch (packet_type) {
|
---|
| 283 | case HCI_EVENT_PACKET:
|
---|
| 284 | event = packet[0];
|
---|
| 285 | switch (event) {
|
---|
| 286 | case BTSTACK_EVENT_STATE:
|
---|
| 287 | /* BT Stack activated, get started */
|
---|
| 288 | if (packet[2] == HCI_STATE_WORKING) {
|
---|
| 289 | hci_send_cmd(&hci_write_local_name, bt_localname);
|
---|
[374] | 290 | if (bt_bnep_mode == 0) {
|
---|
| 291 | // 即時 BNEP Query 開始
|
---|
| 292 | bt_state = BT_STATE_BNEP_QUERY_WAIT;
|
---|
| 293 | bt_timer = 0;
|
---|
| 294 | }
|
---|
| 295 | else {
|
---|
| 296 | bt_state = BT_STATE_BNEP_WAIT;
|
---|
| 297 | bt_timer = -1;
|
---|
| 298 | }
|
---|
[337] | 299 | }
|
---|
| 300 | break;
|
---|
| 301 |
|
---|
| 302 | case BTSTACK_EVENT_NR_CONNECTIONS_CHANGED:
|
---|
| 303 | if ((packet[2] == 0) && bnep_do_connect) {
|
---|
| 304 | bnep_do_connect = false;
|
---|
| 305 | /* Create BNEP connection */
|
---|
| 306 | bnep_connect(NULL, &remote_addr, bnep_l2cap_psm, bnep_remote_uuid);
|
---|
| 307 | }
|
---|
| 308 | break;
|
---|
| 309 |
|
---|
| 310 | case HCI_EVENT_COMMAND_COMPLETE:
|
---|
[374] | 311 | if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_read_bd_addr)) {
|
---|
| 312 | reverse_bd_addr(&packet[6], event_addr);
|
---|
[337] | 313 | log_info("BD-ADDR: %s", bd_addr_to_str(event_addr));
|
---|
| 314 |
|
---|
| 315 | snprintf(bt_localname, sizeof(bt_localname), TARGET_NAME"%04x", ((event_addr[4] << 8) | event_addr[5]));
|
---|
| 316 | gap_set_local_name(bt_localname);
|
---|
| 317 | break;
|
---|
| 318 | }
|
---|
[374] | 319 | if (HCI_EVENT_IS_COMMAND_COMPLETE(packet, hci_write_local_name)) {
|
---|
| 320 | gap_discoverable_control(1);
|
---|
[337] | 321 | break;
|
---|
| 322 | }
|
---|
| 323 | break;
|
---|
| 324 |
|
---|
| 325 | case HCI_EVENT_LINK_KEY_REQUEST:
|
---|
| 326 | // deny link key request
|
---|
| 327 | log_info("Link key request");
|
---|
[374] | 328 | reverse_bd_addr(&packet[2], event_addr);
|
---|
[337] | 329 | hci_send_cmd(&hci_link_key_request_negative_reply, &event_addr);
|
---|
| 330 | break;
|
---|
| 331 |
|
---|
| 332 | case HCI_EVENT_PIN_CODE_REQUEST:
|
---|
| 333 | // inform about pin code request
|
---|
| 334 | log_info("Pin code request - using '0000'");
|
---|
[374] | 335 | reverse_bd_addr(&packet[2], event_addr);
|
---|
[337] | 336 | hci_send_cmd(&hci_pin_code_request_reply, &event_addr, 4, "0000");
|
---|
| 337 | break;
|
---|
| 338 |
|
---|
| 339 | case HCI_EVENT_USER_CONFIRMATION_REQUEST:
|
---|
| 340 | // inform about user confirmation request
|
---|
[374] | 341 | log_info("HCI User Confirmation Request with numeric value '%06u'", little_endian_read_32(packet, 8));
|
---|
[337] | 342 | log_info("HCI User Confirmation Auto accept");
|
---|
| 343 | break;
|
---|
| 344 |
|
---|
| 345 | case RFCOMM_EVENT_INCOMING_CONNECTION:
|
---|
| 346 | // data: event (8), len(8), address(48), channel (8), rfcomm_cid (16)
|
---|
[374] | 347 | reverse_bd_addr(&packet[2], event_addr);
|
---|
[337] | 348 | rfcomm_channel_nr = packet[8];
|
---|
[374] | 349 | rfcomm_channel_id = little_endian_read_16(packet, 9);
|
---|
[337] | 350 | log_info("RFCOMM channel %u requested for %s", rfcomm_channel_nr, bd_addr_to_str(event_addr));
|
---|
| 351 | rfcomm_accept_connection_internal(rfcomm_channel_id);
|
---|
| 352 | break;
|
---|
| 353 |
|
---|
| 354 | case RFCOMM_EVENT_OPEN_CHANNEL_COMPLETE:
|
---|
| 355 | // data: event(8), len(8), status (8), address (48), server channel(8), rfcomm_cid(16), max frame size(16)
|
---|
| 356 | if (packet[2]) {
|
---|
| 357 | log_info("RFCOMM channel open failed, status %u", packet[2]);
|
---|
| 358 | }
|
---|
| 359 | else {
|
---|
[374] | 360 | rfcomm_channel_id = little_endian_read_16(packet, 12);
|
---|
| 361 | mtu = little_endian_read_16(packet, 14);
|
---|
[337] | 362 | log_info("RFCOMM channel open succeeded. New RFCOMM Channel ID %u, max frame size %u", rfcomm_channel_id, mtu);
|
---|
| 363 | }
|
---|
| 364 | break;
|
---|
| 365 |
|
---|
| 366 | case RFCOMM_EVENT_CHANNEL_CLOSED:
|
---|
| 367 | log_info("RFCOMM channel closed");
|
---|
| 368 | rfcomm_channel_id = 0;
|
---|
| 369 | break;
|
---|
| 370 |
|
---|
| 371 | case BNEP_EVENT_OPEN_CHANNEL_COMPLETE:
|
---|
| 372 | if (packet[2]) {
|
---|
| 373 | log_info("BNEP channel open failed, status %02x", packet[2]);
|
---|
[374] | 374 |
|
---|
| 375 | // 30秒後 BNEP Query 開始
|
---|
| 376 | bt_state = BT_STATE_BNEP_QUERY_WAIT;
|
---|
| 377 | bt_timer = 30 * 1000;
|
---|
[337] | 378 | }
|
---|
| 379 | else {
|
---|
| 380 | // data: event(8), len(8), status (8), bnep source uuid (16), bnep destination uuid (16), remote_address (48)
|
---|
[374] | 381 | bnep_cid = little_endian_read_16(packet, 3);
|
---|
| 382 | uuid_source = little_endian_read_16(packet, 5);
|
---|
| 383 | uuid_dest = little_endian_read_16(packet, 7);
|
---|
| 384 | mtu = little_endian_read_16(packet, 9);
|
---|
| 385 | //reverse_bd_addr(&packet[11], remote_addr);
|
---|
[337] | 386 | memcpy(&remote_addr, &packet[11], sizeof(bd_addr_t));
|
---|
| 387 | log_info("BNEP connection open succeeded to %s source UUID 0x%04x dest UUID: 0x%04x, max frame size %u", bd_addr_to_str(event_addr), uuid_source, uuid_dest, mtu);
|
---|
| 388 | /* Setup network interface */
|
---|
| 389 | btstack_network_up(bnep_cid, (uint8_t *)hci_local_bd_addr(), (uint8_t *)remote_addr);
|
---|
| 390 | log_info("Network Interface %s activated", btstack_network_get_name(bnep_cid));
|
---|
[374] | 391 |
|
---|
| 392 | bt_state = BT_STATE_CONNECTED;
|
---|
| 393 | bt_timer = -1;
|
---|
[337] | 394 | }
|
---|
| 395 | break;
|
---|
| 396 |
|
---|
| 397 | case BNEP_EVENT_CHANNEL_TIMEOUT:
|
---|
| 398 | log_info("BNEP channel timeout! Channel will be closed");
|
---|
| 399 | break;
|
---|
| 400 |
|
---|
| 401 | case BNEP_EVENT_CHANNEL_CLOSED:
|
---|
[374] | 402 | bnep_cid = little_endian_read_16(packet, 2);
|
---|
[337] | 403 | bt_channel_closed(bnep_cid);
|
---|
[374] | 404 |
|
---|
| 405 | // 30秒後 BNEP Query 開始
|
---|
| 406 | bt_state = BT_STATE_BNEP_QUERY_WAIT;
|
---|
| 407 | bt_timer = 30 * 1000;
|
---|
[337] | 408 | break;
|
---|
| 409 |
|
---|
| 410 | case BNEP_EVENT_READY_TO_SEND:
|
---|
[374] | 411 | bnep_cid = little_endian_read_16(packet, 2);
|
---|
[337] | 412 | bt_send_packet(bnep_cid);
|
---|
| 413 | break;
|
---|
| 414 |
|
---|
| 415 | default:
|
---|
| 416 | break;
|
---|
| 417 | }
|
---|
| 418 | break;
|
---|
| 419 |
|
---|
| 420 | case RFCOMM_DATA_PACKET:
|
---|
| 421 | // loopback
|
---|
| 422 | if (rfcomm_channel_id) {
|
---|
| 423 | int err = rfcomm_send_internal(rfcomm_channel_id, packet, size);
|
---|
| 424 | if (err) {
|
---|
| 425 | log_error("rfcomm_send_internal -> error %d", err);
|
---|
| 426 | }
|
---|
| 427 | }
|
---|
| 428 | break;
|
---|
| 429 |
|
---|
| 430 | case BNEP_DATA_PACKET:
|
---|
| 431 | bt_recv_packet(channel, packet, size);
|
---|
| 432 | break;
|
---|
| 433 |
|
---|
| 434 | default:
|
---|
| 435 | break;
|
---|
| 436 | }
|
---|
| 437 | }
|
---|
| 438 |
|
---|
| 439 | /*
|
---|
| 440 | * @section Network packet handler
|
---|
| 441 | *
|
---|
| 442 | * @text A pointer to the network packet is stored and a BNEP_EVENT_CAN_SEND_NOW requested
|
---|
| 443 | */
|
---|
| 444 |
|
---|
| 445 | /* LISTING_START(networkPacketHandler): Network Packet Handler */
|
---|
| 446 | static void network_send_packet_callback(uint16_t bnep_cid, const uint8_t * packet, uint16_t size) {
|
---|
| 447 | if ((bnep_cid == 0) || (network_buffer_len > 0)) {
|
---|
| 448 | #ifdef PACKET_DUMP
|
---|
| 449 | int len = size;
|
---|
| 450 | printf("DROP %04x %d ", bnep_cid, size);
|
---|
| 451 | if (len > 128)
|
---|
| 452 | len = 128;
|
---|
| 453 | printf_hexdump(packet, len);
|
---|
| 454 | #endif
|
---|
| 455 | if (network_buffer_len > 0) {
|
---|
| 456 | network_buffer_len = 0;
|
---|
| 457 | btstack_network_packet_sent(network_buffer_cid);
|
---|
| 458 | }
|
---|
| 459 | }
|
---|
| 460 |
|
---|
| 461 | network_buffer_cid = bnep_cid;
|
---|
| 462 | network_buffer = packet;
|
---|
| 463 | network_buffer_len = size;
|
---|
| 464 | }
|
---|
| 465 |
|
---|
[374] | 466 | void bt_init(void)
|
---|
[337] | 467 | {
|
---|
| 468 | const hci_transport_t *transport;
|
---|
| 469 | bt_control_t * control;
|
---|
| 470 | hci_uart_config_t * config;
|
---|
| 471 | remote_device_db_t * remote_db;
|
---|
| 472 | service_record_item_t *spp_service_record_item;
|
---|
| 473 | service_record_item_t *bnep_service_record_item;
|
---|
| 474 |
|
---|
[374] | 475 | btstack_network_init(&network_send_packet_callback);
|
---|
| 476 |
|
---|
[337] | 477 | //hci_dump_open("", HCI_DUMP_PACKETLOGGER);
|
---|
| 478 |
|
---|
| 479 | // start with BTstack init - especially configure HCI Transport
|
---|
| 480 | btstack_memory_init();
|
---|
| 481 | run_loop_init(RUN_LOOP_EMBEDDED);
|
---|
| 482 |
|
---|
| 483 | /* Initialize HCI */
|
---|
| 484 | transport = hci_transport_usb_instance();
|
---|
| 485 | control = NULL;
|
---|
| 486 | config = NULL;
|
---|
| 487 | remote_db = (remote_device_db_t *)&remote_device_db_memory;
|
---|
| 488 | hci_init(transport, config, control, remote_db);
|
---|
| 489 | hci_set_class_of_device(0x820300/*0x820810*/);
|
---|
| 490 |
|
---|
| 491 | /* Initialize L2CAP */
|
---|
| 492 | l2cap_init();
|
---|
| 493 | l2cap_register_packet_handler(packet_handler);
|
---|
| 494 |
|
---|
| 495 | /* Initialise SDP, create record for SPP and register with SDP */
|
---|
| 496 | sdp_init();
|
---|
| 497 |
|
---|
| 498 | /* Initialize RFCOMM */
|
---|
| 499 | rfcomm_init();
|
---|
| 500 | rfcomm_register_packet_handler(packet_handler);
|
---|
| 501 | rfcomm_register_service_internal(NULL, RFCOMM_SERVER_CHANNEL, 0xffff); // reserved channel, mtu=100
|
---|
| 502 |
|
---|
| 503 | /* Initialise BNEP */
|
---|
| 504 | bnep_init();
|
---|
| 505 | bnep_register_packet_handler(packet_handler);
|
---|
[374] | 506 | if (bt_bnep_mode == 0) {
|
---|
| 507 | bnep_register_service(NULL, BLUETOOTH_SERVICE_CLASS_PANU, BNEP_MTU_MIN); /* Minimum L2CAP MTU for bnep is 1691 bytes */
|
---|
| 508 | }
|
---|
| 509 | else {
|
---|
| 510 | bnep_register_service(NULL, BLUETOOTH_SERVICE_CLASS_NAP, BNEP_MTU_MIN); /* Minimum L2CAP MTU for bnep is 1691 bytes */
|
---|
| 511 | }
|
---|
[337] | 512 |
|
---|
| 513 | memset(spp_service_buffer, 0, sizeof(spp_service_buffer));
|
---|
| 514 | memset(bnep_service_buffer, 0, sizeof(bnep_service_buffer));
|
---|
| 515 |
|
---|
| 516 | // サービス定義
|
---|
| 517 | spp_service_record_item = (service_record_item_t *)spp_service_buffer;
|
---|
| 518 | bnep_service_record_item = (service_record_item_t *)bnep_service_buffer;
|
---|
| 519 |
|
---|
| 520 | sdp_create_spp_service((uint8_t*)&spp_service_record_item->service_record, 1, "RX SPP");
|
---|
| 521 | de_dump_data_element((uint8_t*)spp_service_record_item->service_record);
|
---|
| 522 | log_info("SSP SDP service buffer size: %u", (uint16_t)(sizeof(service_record_item_t) + de_get_len((uint8_t*)spp_service_record_item->service_record)));
|
---|
| 523 | sdp_register_service_internal(NULL, spp_service_record_item);
|
---|
| 524 |
|
---|
[374] | 525 | if (bt_bnep_mode == 0) {
|
---|
| 526 | pan_create_panu_service((uint8_t*)&bnep_service_record_item->service_record, "RX PANU", "RX PANU", BNEP_SECURITY_NONE);
|
---|
| 527 | de_dump_data_element((uint8_t*)bnep_service_record_item->service_record);
|
---|
| 528 | log_info("PANU SDP service buffer size: %u", (uint16_t)(sizeof(service_record_item_t) + de_get_len((uint8_t*)bnep_service_record_item->service_record)));
|
---|
| 529 | }
|
---|
| 530 | else {
|
---|
| 531 | pan_create_nap_service((uint8_t*)&bnep_service_record_item->service_record, "RX NAP", "RX NAP", BNEP_SECURITY_NONE,
|
---|
| 532 | PAN_NET_ACCESS_TYPE_100MB_ETHERNET, 0x0001312D0/*10Mb/sec*/, NULL, NULL);
|
---|
| 533 | de_dump_data_element((uint8_t*)bnep_service_record_item->service_record);
|
---|
| 534 | log_info("NAP SDP service buffer size: %u", (uint16_t)(sizeof(service_record_item_t) + de_get_len((uint8_t*)bnep_service_record_item->service_record)));
|
---|
| 535 | }
|
---|
[337] | 536 | sdp_register_service_internal(NULL, bnep_service_record_item);
|
---|
| 537 |
|
---|
| 538 | // Secure Simple Pairing configuration -> just works
|
---|
| 539 | hci_ssp_set_enable(1);
|
---|
| 540 | hci_ssp_set_io_capability(SSP_IO_CAPABILITY_NO_INPUT_NO_OUTPUT);
|
---|
| 541 | hci_ssp_set_auto_accept(1);
|
---|
| 542 |
|
---|
| 543 | /* Turn on the device */
|
---|
| 544 | hci_power_control(HCI_POWER_ON);
|
---|
| 545 |
|
---|
| 546 | /* Initialise SDP */
|
---|
| 547 | sdp_parser_init();
|
---|
| 548 | sdp_parser_register_callback(handle_sdp_client_query_result);
|
---|
[374] | 549 |
|
---|
| 550 | bt_state = BT_STATE_POWER_ON;
|
---|
| 551 | bt_timer = -1;
|
---|
[337] | 552 | }
|
---|
| 553 |
|
---|
[374] | 554 | void bt_process(void)
|
---|
[337] | 555 | {
|
---|
[374] | 556 | if (bt_state != BT_STATE_DORMANT) {
|
---|
| 557 | run_loop_execute();
|
---|
| 558 | bt_send_packet(0xffff);
|
---|
[337] | 559 | }
|
---|
| 560 |
|
---|
[374] | 561 | if (bt_timer != 0)
|
---|
| 562 | return;
|
---|
[337] | 563 |
|
---|
[374] | 564 | switch (bt_state) {
|
---|
| 565 | case BT_STATE_BNEP_QUERY_WAIT:
|
---|
| 566 | /* Send a general query for BNEP Protocol ID */
|
---|
| 567 | log_info("Start SDP BNEP query.");
|
---|
| 568 | sdp_general_query_for_uuid(remote_addr, BLUETOOTH_PROTOCOL_BNEP);
|
---|
[337] | 569 |
|
---|
[374] | 570 | bt_state = BT_STATE_BNEP_QUERY;
|
---|
| 571 | bt_timer = -1;
|
---|
| 572 | break;
|
---|
| 573 | default:
|
---|
| 574 | bt_timer = -1;
|
---|
| 575 | break;
|
---|
[337] | 576 | }
|
---|
| 577 | }
|
---|
| 578 |
|
---|
| 579 | int bt_can_send_packet(void)
|
---|
| 580 | {
|
---|
| 581 | return network_buffer_len == 0;
|
---|
| 582 | }
|
---|
| 583 |
|
---|
| 584 | void bt_send_packet(uint16_t bnep_cid)
|
---|
| 585 | {
|
---|
| 586 | if (network_buffer_len > 0) {
|
---|
| 587 | if (network_buffer_cid == 0) {
|
---|
| 588 | network_buffer_len = 0;
|
---|
| 589 | btstack_network_packet_sent(network_buffer_cid);
|
---|
| 590 | return;
|
---|
| 591 | }
|
---|
| 592 | /* Check for parked network packets and send it out now */
|
---|
| 593 | if (bnep_can_send_packet_now(network_buffer_cid)) {
|
---|
| 594 | uint16_t len = network_buffer_len;
|
---|
| 595 | #ifdef PACKET_DUMP
|
---|
| 596 | printf("ETH %u => ", len);
|
---|
| 597 | if (len > 128)
|
---|
| 598 | len = 128;
|
---|
| 599 | printf_hexdump(network_buffer, len);
|
---|
| 600 | #endif
|
---|
| 601 | // この関数はbnep_sendから再帰呼び出しされるので、
|
---|
| 602 | // bnep_sendを呼び出すより前に送信パケットなし状態にします。
|
---|
| 603 | network_buffer_len = 0;
|
---|
| 604 | bnep_send(network_buffer_cid, (uint8_t*)network_buffer, len);
|
---|
| 605 | btstack_network_packet_sent(network_buffer_cid);
|
---|
| 606 | }
|
---|
| 607 | }
|
---|
| 608 | }
|
---|
| 609 |
|
---|
| 610 | void bt_recv_packet(uint16_t bnep_cid, const uint8_t * packet, uint16_t size)
|
---|
| 611 | {
|
---|
| 612 | #ifdef PACKET_DUMP
|
---|
| 613 | int len = size;
|
---|
| 614 | printf("ETH %d <= ", size);
|
---|
| 615 | if (len > 128)
|
---|
| 616 | len = 128;
|
---|
| 617 | printf_hexdump(packet, len);
|
---|
| 618 | #endif
|
---|
| 619 | btstack_network_process_packet(bnep_cid, packet, size);
|
---|
| 620 | }
|
---|
| 621 |
|
---|
| 622 | void bt_channel_closed(uint16_t bnep_cid)
|
---|
| 623 | {
|
---|
| 624 | log_info("BNEP channel closed");
|
---|
| 625 | btstack_network_down(bnep_cid);
|
---|
| 626 | if ((network_buffer_len > 0) && (network_buffer_cid == bnep_cid)) {
|
---|
| 627 | network_buffer_len = 0;
|
---|
| 628 | btstack_network_packet_sent(network_buffer_cid);
|
---|
| 629 | }
|
---|
| 630 | }
|
---|
| 631 |
|
---|
| 632 | void bt_terminate(void)
|
---|
| 633 | {
|
---|
| 634 | hci_close();
|
---|
| 635 |
|
---|
[374] | 636 | bt_state = BT_STATE_DORMANT;
|
---|
| 637 | bt_timer = -1;
|
---|
[337] | 638 | }
|
---|
[374] | 639 |
|
---|
| 640 | void bt_task_on_start(struct task_if_t *task, ID tskid)
|
---|
| 641 | {
|
---|
| 642 | }
|
---|
| 643 |
|
---|
| 644 | void bt_task_on_end(struct task_if_t *task)
|
---|
| 645 | {
|
---|
| 646 | }
|
---|
| 647 |
|
---|
| 648 | int bt_task_get_timer(struct task_if_t *task)
|
---|
| 649 | {
|
---|
| 650 | return bt_timer;
|
---|
| 651 | }
|
---|
| 652 |
|
---|
| 653 | void bt_task_progress(struct task_if_t *task, int elapse)
|
---|
| 654 | {
|
---|
| 655 | if (bt_timer == -1)
|
---|
| 656 | return;
|
---|
| 657 |
|
---|
| 658 | bt_timer -= elapse;
|
---|
| 659 | if (bt_timer < 0)
|
---|
| 660 | bt_timer = 0;
|
---|
| 661 | }
|
---|
| 662 |
|
---|
| 663 | void bt_task_process(struct task_if_t *task, enum task_event_t event)
|
---|
| 664 | {
|
---|
| 665 | extern void hal_tick_handler();
|
---|
| 666 |
|
---|
| 667 | switch (event & ~TASK_EVENT_TICK) {
|
---|
| 668 | case TASK_EVENT_START:
|
---|
| 669 | bt_init();
|
---|
| 670 | break;
|
---|
| 671 | case TASK_EVENT_TERMINATE:
|
---|
| 672 | bt_terminate();
|
---|
| 673 | break;
|
---|
| 674 | case TASK_EVENT_WAKEUP:
|
---|
| 675 | case TASK_EVENT_TIMEOUT:
|
---|
| 676 | if (event & TASK_EVENT_TICK)
|
---|
| 677 | hal_tick_handler();
|
---|
| 678 | bt_process();
|
---|
| 679 | break;
|
---|
| 680 | }
|
---|
| 681 | }
|
---|
| 682 |
|
---|
| 683 | struct task_if_t bt_task = {
|
---|
| 684 | bt_task_on_start,
|
---|
| 685 | bt_task_on_end,
|
---|
| 686 | bt_task_get_timer,
|
---|
| 687 | bt_task_progress,
|
---|
| 688 | bt_task_process,
|
---|
| 689 | };
|
---|