1bcf00d8fSMatthias Ringwald /* 2bcf00d8fSMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 3bcf00d8fSMatthias Ringwald * 4bcf00d8fSMatthias Ringwald * Redistribution and use in source and binary forms, with or without 5bcf00d8fSMatthias Ringwald * modification, are permitted provided that the following conditions 6bcf00d8fSMatthias Ringwald * are met: 7bcf00d8fSMatthias Ringwald * 8bcf00d8fSMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 9bcf00d8fSMatthias Ringwald * notice, this list of conditions and the following disclaimer. 10bcf00d8fSMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 11bcf00d8fSMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 12bcf00d8fSMatthias Ringwald * documentation and/or other materials provided with the distribution. 13bcf00d8fSMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 14bcf00d8fSMatthias Ringwald * contributors may be used to endorse or promote products derived 15bcf00d8fSMatthias Ringwald * from this software without specific prior written permission. 16bcf00d8fSMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 17bcf00d8fSMatthias Ringwald * personal benefit and not for any commercial purpose or for 18bcf00d8fSMatthias Ringwald * monetary gain. 19bcf00d8fSMatthias Ringwald * 20bcf00d8fSMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21bcf00d8fSMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22bcf00d8fSMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23bcf00d8fSMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24bcf00d8fSMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25bcf00d8fSMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26bcf00d8fSMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27bcf00d8fSMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28bcf00d8fSMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29bcf00d8fSMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30bcf00d8fSMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31bcf00d8fSMatthias Ringwald * SUCH DAMAGE. 32bcf00d8fSMatthias Ringwald * 33bcf00d8fSMatthias Ringwald * Please inquire about commercial licensing options at 34bcf00d8fSMatthias Ringwald * [email protected] 35bcf00d8fSMatthias Ringwald * 36bcf00d8fSMatthias Ringwald */ 37bcf00d8fSMatthias Ringwald 38ab2c6ae4SMatthias Ringwald #define __BTSTACK_FILE__ "panu_demo.c" 39ab2c6ae4SMatthias Ringwald 40bcf00d8fSMatthias Ringwald /* 41bcf00d8fSMatthias Ringwald * panu_demo.c 42bcf00d8fSMatthias Ringwald * Author: Ole Reinhardt <[email protected]> 43bcf00d8fSMatthias Ringwald */ 44bcf00d8fSMatthias Ringwald 45bcf00d8fSMatthias Ringwald /* EXAMPLE_START(panu_demo): PANU Demo 46bcf00d8fSMatthias Ringwald * 47bcf00d8fSMatthias Ringwald * @text This example implements both a PANU client and a server. In server mode, it 48bcf00d8fSMatthias Ringwald * sets up a BNEP server and registers a PANU SDP record and waits for incoming connections. 49bcf00d8fSMatthias Ringwald * In client mode, it connects to a remote device, does an SDP Query to identify the PANU 50bcf00d8fSMatthias Ringwald * service and initiates a BNEP connection. 51bcf00d8fSMatthias Ringwald */ 52bcf00d8fSMatthias Ringwald 53bcf00d8fSMatthias Ringwald #include "btstack_config.h" 54bcf00d8fSMatthias Ringwald 55bcf00d8fSMatthias Ringwald #include <arpa/inet.h> 56bcf00d8fSMatthias Ringwald #include <errno.h> 57bcf00d8fSMatthias Ringwald #include <fcntl.h> 58bcf00d8fSMatthias Ringwald #include <ifaddrs.h> 59bcf00d8fSMatthias Ringwald #include <stdint.h> 60bcf00d8fSMatthias Ringwald #include <stdio.h> 61bcf00d8fSMatthias Ringwald #include <stdlib.h> 62bcf00d8fSMatthias Ringwald #include <string.h> 63bcf00d8fSMatthias Ringwald #include <unistd.h> 64bcf00d8fSMatthias Ringwald 65bcf00d8fSMatthias Ringwald #include <net/if_arp.h> 66bcf00d8fSMatthias Ringwald 67bcf00d8fSMatthias Ringwald #ifdef __APPLE__ 68bcf00d8fSMatthias Ringwald #include <net/if.h> 69bcf00d8fSMatthias Ringwald #include <net/if_types.h> 70bcf00d8fSMatthias Ringwald 71bcf00d8fSMatthias Ringwald #include <netinet/if_ether.h> 72bcf00d8fSMatthias Ringwald #include <netinet/in.h> 73bcf00d8fSMatthias Ringwald #endif 74bcf00d8fSMatthias Ringwald 75bcf00d8fSMatthias Ringwald #include <sys/ioctl.h> 76bcf00d8fSMatthias Ringwald #include <sys/param.h> 77bcf00d8fSMatthias Ringwald #include <sys/socket.h> 78bcf00d8fSMatthias Ringwald #include <sys/stat.h> 79bcf00d8fSMatthias Ringwald #include <sys/types.h> 80bcf00d8fSMatthias Ringwald 81bcf00d8fSMatthias Ringwald #ifdef __linux 82bcf00d8fSMatthias Ringwald #include <linux/if.h> 83bcf00d8fSMatthias Ringwald #include <linux/if_tun.h> 84bcf00d8fSMatthias Ringwald #endif 85bcf00d8fSMatthias Ringwald 86bcf00d8fSMatthias Ringwald #include "btstack_memory.h" 87bcf00d8fSMatthias Ringwald #include "btstack_event.h" 88bcf00d8fSMatthias Ringwald #include "btstack_run_loop.h" 89bcf00d8fSMatthias Ringwald #include "classic/sdp_client.h" 90bcf00d8fSMatthias Ringwald #include "classic/sdp_util.h" 91bcf00d8fSMatthias Ringwald #include "hci.h" 92bcf00d8fSMatthias Ringwald #include "hci_cmd.h" 93bcf00d8fSMatthias Ringwald #include "hci_dump.h" 94bcf00d8fSMatthias Ringwald #include "l2cap.h" 95bcf00d8fSMatthias Ringwald #include "pan.h" 96bcf00d8fSMatthias Ringwald 97bcf00d8fSMatthias Ringwald static int record_id = -1; 98bcf00d8fSMatthias Ringwald static uint16_t bnep_l2cap_psm = 0; 99bcf00d8fSMatthias Ringwald static uint32_t bnep_remote_uuid = 0; 100bcf00d8fSMatthias Ringwald static uint16_t bnep_version = 0; 101bcf00d8fSMatthias Ringwald static uint16_t bnep_cid = 0; 102bcf00d8fSMatthias Ringwald 103bcf00d8fSMatthias Ringwald static uint8_t attribute_value[1000]; 104bcf00d8fSMatthias Ringwald static const unsigned int attribute_value_buffer_size = sizeof(attribute_value); 105bcf00d8fSMatthias Ringwald 106bcf00d8fSMatthias Ringwald //static bd_addr_t remote = {0x04,0x0C,0xCE,0xE4,0x85,0xD3}; 107bcf00d8fSMatthias Ringwald // static bd_addr_t remote = {0xE0,0x06,0xE6,0xBB,0x95,0x79}; // Ole Thinkpad 108bcf00d8fSMatthias Ringwald static bd_addr_t remote = {0x84,0x38,0x35,0x65,0xD1,0x15}; // MacBook 2013 109bcf00d8fSMatthias Ringwald 110bcf00d8fSMatthias Ringwald static int tap_fd = -1; 111bcf00d8fSMatthias Ringwald static uint8_t network_buffer[BNEP_MTU_MIN]; 112bcf00d8fSMatthias Ringwald static size_t network_buffer_len = 0; 113bcf00d8fSMatthias Ringwald 114bcf00d8fSMatthias Ringwald #ifdef __APPLE__ 115bcf00d8fSMatthias Ringwald // tuntaposx provides fixed set of tapX devices 116bcf00d8fSMatthias Ringwald static const char * tap_dev = "/dev/tap0"; 117bcf00d8fSMatthias Ringwald static char tap_dev_name[16] = "tap0"; 118bcf00d8fSMatthias Ringwald #endif 119bcf00d8fSMatthias Ringwald 120bcf00d8fSMatthias Ringwald #ifdef __linux 121bcf00d8fSMatthias Ringwald // Linux uses single control device to bring up tunX or tapX interface 122bcf00d8fSMatthias Ringwald static const char * tap_dev = "/dev/net/tun"; 123bcf00d8fSMatthias Ringwald static char tap_dev_name[16] = "bnep%d"; 124bcf00d8fSMatthias Ringwald #endif 125bcf00d8fSMatthias Ringwald 126bcf00d8fSMatthias Ringwald 127bcf00d8fSMatthias Ringwald static btstack_data_source_t tap_dev_ds; 128bcf00d8fSMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 129bcf00d8fSMatthias Ringwald 130bcf00d8fSMatthias Ringwald /* @section Main application configuration 131bcf00d8fSMatthias Ringwald * 132bcf00d8fSMatthias Ringwald * @text In the application configuration, L2CAP and BNEP are initialized and a BNEP service, for server mode, 133bcf00d8fSMatthias Ringwald * is registered, before the Bluetooth stack gets started, as shown in Listing PanuSetup. 134bcf00d8fSMatthias Ringwald */ 135bcf00d8fSMatthias Ringwald 136bcf00d8fSMatthias Ringwald /* LISTING_START(PanuSetup): Panu setup */ 137bcf00d8fSMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 138423c667cSMatthias Ringwald static void handle_sdp_client_query_result(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 139bcf00d8fSMatthias Ringwald 140bcf00d8fSMatthias Ringwald static void panu_setup(void){ 141bcf00d8fSMatthias Ringwald 142bcf00d8fSMatthias Ringwald // register for HCI events 143bcf00d8fSMatthias Ringwald hci_event_callback_registration.callback = &packet_handler; 144bcf00d8fSMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 145bcf00d8fSMatthias Ringwald 146bcf00d8fSMatthias Ringwald // Initialize L2CAP 147bcf00d8fSMatthias Ringwald l2cap_init(); 148bcf00d8fSMatthias Ringwald 149bcf00d8fSMatthias Ringwald // Initialise BNEP 150bcf00d8fSMatthias Ringwald bnep_init(); 151bcf00d8fSMatthias Ringwald // Minimum L2CAP MTU for bnep is 1691 bytes 152*235946f1SMatthias Ringwald bnep_register_service(packet_handler, BLUETOOTH_SERVICE_CLASS_PANU, 1691); 153bcf00d8fSMatthias Ringwald } 154bcf00d8fSMatthias Ringwald /* LISTING_END */ 155bcf00d8fSMatthias Ringwald 156bcf00d8fSMatthias Ringwald /* @section TUN / TAP interface routines 157bcf00d8fSMatthias Ringwald * 158bcf00d8fSMatthias Ringwald * @text This example requires a TUN/TAP interface to connect the Bluetooth network interface 159bcf00d8fSMatthias Ringwald * with the native system. It has been tested on Linux and OS X, but should work on any 160bcf00d8fSMatthias Ringwald * system that provides TUN/TAP with minor modifications. 161bcf00d8fSMatthias Ringwald * 162bcf00d8fSMatthias Ringwald * On Linux, TUN/TAP is available by default. On OS X, tuntaposx from 163bcf00d8fSMatthias Ringwald * http://tuntaposx.sourceforge.net needs to be installed. 164bcf00d8fSMatthias Ringwald * 165bcf00d8fSMatthias Ringwald * The *tap_alloc* function sets up a virtual network interface with the given Bluetooth Address. 166bcf00d8fSMatthias Ringwald * It is rather low-level as it sets up and configures a network interface. 167bcf00d8fSMatthias Ringwald */ 168bcf00d8fSMatthias Ringwald 169bcf00d8fSMatthias Ringwald static int tap_alloc(char *dev, bd_addr_t bd_addr) 170bcf00d8fSMatthias Ringwald { 171bcf00d8fSMatthias Ringwald struct ifreq ifr; 172bcf00d8fSMatthias Ringwald int fd_dev; 173bcf00d8fSMatthias Ringwald int fd_socket; 174bcf00d8fSMatthias Ringwald 175bcf00d8fSMatthias Ringwald if( (fd_dev = open(tap_dev, O_RDWR)) < 0 ) { 176bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error opening %s: %s\n", tap_dev, strerror(errno)); 177bcf00d8fSMatthias Ringwald return -1; 178bcf00d8fSMatthias Ringwald } 179bcf00d8fSMatthias Ringwald 180bcf00d8fSMatthias Ringwald #ifdef __linux 181bcf00d8fSMatthias Ringwald memset(&ifr, 0, sizeof(ifr)); 182bcf00d8fSMatthias Ringwald 183bcf00d8fSMatthias Ringwald ifr.ifr_flags = IFF_TAP | IFF_NO_PI; 184bcf00d8fSMatthias Ringwald if( *dev ) { 185bcf00d8fSMatthias Ringwald strncpy(ifr.ifr_name, dev, IFNAMSIZ); 186bcf00d8fSMatthias Ringwald } 187bcf00d8fSMatthias Ringwald 188bcf00d8fSMatthias Ringwald int err; 189bcf00d8fSMatthias Ringwald if( (err = ioctl(fd_dev, TUNSETIFF, (void *) &ifr)) < 0 ) { 190bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error setting device name: %s\n", strerror(errno)); 191bcf00d8fSMatthias Ringwald close(fd_dev); 192bcf00d8fSMatthias Ringwald return -1; 193bcf00d8fSMatthias Ringwald } 194bcf00d8fSMatthias Ringwald strcpy(dev, ifr.ifr_name); 195bcf00d8fSMatthias Ringwald #endif 196bcf00d8fSMatthias Ringwald #ifdef __APPLE__ 197bcf00d8fSMatthias Ringwald dev = tap_dev_name; 198bcf00d8fSMatthias Ringwald #endif 199bcf00d8fSMatthias Ringwald 200bcf00d8fSMatthias Ringwald fd_socket = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP); 201bcf00d8fSMatthias Ringwald if (fd_socket < 0) { 202bcf00d8fSMatthias Ringwald close(fd_dev); 203bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error opening netlink socket: %s\n", strerror(errno)); 204bcf00d8fSMatthias Ringwald return -1; 205bcf00d8fSMatthias Ringwald } 206bcf00d8fSMatthias Ringwald 207bcf00d8fSMatthias Ringwald // Configure the MAC address of the newly created bnep(x) 208bcf00d8fSMatthias Ringwald // device to the local bd_address 209bcf00d8fSMatthias Ringwald memset (&ifr, 0, sizeof(struct ifreq)); 210bcf00d8fSMatthias Ringwald strcpy(ifr.ifr_name, dev); 211bcf00d8fSMatthias Ringwald #ifdef __linux 212bcf00d8fSMatthias Ringwald ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER; 213bcf00d8fSMatthias Ringwald memcpy(ifr.ifr_hwaddr.sa_data, bd_addr, sizeof(bd_addr_t)); 214bcf00d8fSMatthias Ringwald if (ioctl(fd_socket, SIOCSIFHWADDR, &ifr) == -1) { 215bcf00d8fSMatthias Ringwald close(fd_dev); 216bcf00d8fSMatthias Ringwald close(fd_socket); 217bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error setting hw addr: %s\n", strerror(errno)); 218bcf00d8fSMatthias Ringwald exit(1); 219bcf00d8fSMatthias Ringwald return -1; 220bcf00d8fSMatthias Ringwald } 221bcf00d8fSMatthias Ringwald #endif 222bcf00d8fSMatthias Ringwald #ifdef __APPLE__ 223bcf00d8fSMatthias Ringwald ifr.ifr_addr.sa_len = ETHER_ADDR_LEN; 224bcf00d8fSMatthias Ringwald ifr.ifr_addr.sa_family = AF_LINK; 225bcf00d8fSMatthias Ringwald (void)memcpy(ifr.ifr_addr.sa_data, bd_addr, ETHER_ADDR_LEN); 226bcf00d8fSMatthias Ringwald if (ioctl(fd_socket, SIOCSIFLLADDR, &ifr) == -1) { 227bcf00d8fSMatthias Ringwald close(fd_dev); 228bcf00d8fSMatthias Ringwald close(fd_socket); 229bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error setting hw addr: %s\n", strerror(errno)); 230bcf00d8fSMatthias Ringwald exit(1); 231bcf00d8fSMatthias Ringwald return -1; 232bcf00d8fSMatthias Ringwald } 233bcf00d8fSMatthias Ringwald #endif 234bcf00d8fSMatthias Ringwald 235bcf00d8fSMatthias Ringwald // Bring the interface up 236bcf00d8fSMatthias Ringwald if (ioctl(fd_socket, SIOCGIFFLAGS, &ifr) == -1) { 237bcf00d8fSMatthias Ringwald close(fd_dev); 238bcf00d8fSMatthias Ringwald close(fd_socket); 239bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error reading interface flags: %s\n", strerror(errno)); 240bcf00d8fSMatthias Ringwald return -1; 241bcf00d8fSMatthias Ringwald } 242bcf00d8fSMatthias Ringwald 243bcf00d8fSMatthias Ringwald if ((ifr.ifr_flags & IFF_UP) == 0) { 244bcf00d8fSMatthias Ringwald ifr.ifr_flags |= IFF_UP; 245bcf00d8fSMatthias Ringwald 246bcf00d8fSMatthias Ringwald if (ioctl(fd_socket, SIOCSIFFLAGS, &ifr) == -1) { 247bcf00d8fSMatthias Ringwald close(fd_dev); 248bcf00d8fSMatthias Ringwald close(fd_socket); 249bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error set IFF_UP: %s\n", strerror(errno)); 250bcf00d8fSMatthias Ringwald return -1; 251bcf00d8fSMatthias Ringwald } 252bcf00d8fSMatthias Ringwald } 253bcf00d8fSMatthias Ringwald 254bcf00d8fSMatthias Ringwald close(fd_socket); 255bcf00d8fSMatthias Ringwald 256bcf00d8fSMatthias Ringwald return fd_dev; 257bcf00d8fSMatthias Ringwald } 258bcf00d8fSMatthias Ringwald 259bcf00d8fSMatthias Ringwald /* 260bcf00d8fSMatthias Ringwald * @text Listing processTapData shows how a packet is received from the TAP network interface 261bcf00d8fSMatthias Ringwald * and forwarded over the BNEP connection. 262bcf00d8fSMatthias Ringwald * 263bcf00d8fSMatthias Ringwald * After successfully reading a network packet, the call to 264bcf00d8fSMatthias Ringwald * the *bnep_can_send_packet_now* function checks, if BTstack can forward 265bcf00d8fSMatthias Ringwald * a network packet now. If that's not possible, the received data stays 266bcf00d8fSMatthias Ringwald * in the network buffer and the data source elements is removed from the 267bcf00d8fSMatthias Ringwald * run loop. The *process_tap_dev_data* function will not be called until 268bcf00d8fSMatthias Ringwald * the data source is registered again. This provides a basic flow control. 269bcf00d8fSMatthias Ringwald */ 270bcf00d8fSMatthias Ringwald 271bcf00d8fSMatthias Ringwald /* LISTING_START(processTapData): Process incoming network packets */ 272423c667cSMatthias Ringwald static void process_tap_dev_data(btstack_data_source_t *ds, btstack_data_source_callback_type_t callback_type) 273bcf00d8fSMatthias Ringwald { 274c83b0215SMatthias Ringwald UNUSED(ds); 275c83b0215SMatthias Ringwald UNUSED(callback_type); 276c83b0215SMatthias Ringwald 277bcf00d8fSMatthias Ringwald ssize_t len; 278bcf00d8fSMatthias Ringwald len = read(ds->fd, network_buffer, sizeof(network_buffer)); 279bcf00d8fSMatthias Ringwald if (len <= 0){ 280bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Error while reading: %s\n", strerror(errno)); 281423c667cSMatthias Ringwald return; 282bcf00d8fSMatthias Ringwald } 283bcf00d8fSMatthias Ringwald 284bcf00d8fSMatthias Ringwald network_buffer_len = len; 285bcf00d8fSMatthias Ringwald if (bnep_can_send_packet_now(bnep_cid)) { 286bcf00d8fSMatthias Ringwald bnep_send(bnep_cid, network_buffer, network_buffer_len); 287bcf00d8fSMatthias Ringwald network_buffer_len = 0; 288bcf00d8fSMatthias Ringwald } else { 289bcf00d8fSMatthias Ringwald // park the current network packet 290bcf00d8fSMatthias Ringwald btstack_run_loop_remove_data_source(&tap_dev_ds); 291bcf00d8fSMatthias Ringwald } 292423c667cSMatthias Ringwald return; 293bcf00d8fSMatthias Ringwald } 294bcf00d8fSMatthias Ringwald /* LISTING_END */ 295bcf00d8fSMatthias Ringwald 296bcf00d8fSMatthias Ringwald // PANU client routines 297bcf00d8fSMatthias Ringwald static char * get_string_from_data_element(uint8_t * element){ 298bcf00d8fSMatthias Ringwald de_size_t de_size = de_get_size_type(element); 299bcf00d8fSMatthias Ringwald int pos = de_get_header_size(element); 300bcf00d8fSMatthias Ringwald int len = 0; 301bcf00d8fSMatthias Ringwald switch (de_size){ 302bcf00d8fSMatthias Ringwald case DE_SIZE_VAR_8: 303bcf00d8fSMatthias Ringwald len = element[1]; 304bcf00d8fSMatthias Ringwald break; 305bcf00d8fSMatthias Ringwald case DE_SIZE_VAR_16: 306bcf00d8fSMatthias Ringwald len = big_endian_read_16(element, 1); 307bcf00d8fSMatthias Ringwald break; 308bcf00d8fSMatthias Ringwald default: 309bcf00d8fSMatthias Ringwald break; 310bcf00d8fSMatthias Ringwald } 311bcf00d8fSMatthias Ringwald char * str = (char*)malloc(len+1); 312bcf00d8fSMatthias Ringwald memcpy(str, &element[pos], len); 313bcf00d8fSMatthias Ringwald str[len] ='\0'; 314bcf00d8fSMatthias Ringwald return str; 315bcf00d8fSMatthias Ringwald } 316bcf00d8fSMatthias Ringwald 317bcf00d8fSMatthias Ringwald 318bcf00d8fSMatthias Ringwald /* @section SDP parser callback 319bcf00d8fSMatthias Ringwald * 320bcf00d8fSMatthias Ringwald * @text The SDP parsers retrieves the BNEP PAN UUID as explained in 321bcf00d8fSMatthias Ringwald * Section [on SDP BNEP Query example](#sec:sdpbnepqueryExample}. 322bcf00d8fSMatthias Ringwald */ 323423c667cSMatthias Ringwald static void handle_sdp_client_query_result(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) { 324bcf00d8fSMatthias Ringwald 325c83b0215SMatthias Ringwald UNUSED(packet_type); 326c83b0215SMatthias Ringwald UNUSED(channel); 327c83b0215SMatthias Ringwald UNUSED(size); 328c83b0215SMatthias Ringwald 329bcf00d8fSMatthias Ringwald des_iterator_t des_list_it; 330bcf00d8fSMatthias Ringwald des_iterator_t prot_it; 331bcf00d8fSMatthias Ringwald char *str; 332bcf00d8fSMatthias Ringwald 3330e2df43fSMatthias Ringwald switch (hci_event_packet_get_type(packet)){ 334bcf00d8fSMatthias Ringwald case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 335bcf00d8fSMatthias Ringwald // Handle new SDP record 336bcf00d8fSMatthias Ringwald if (sdp_event_query_attribute_byte_get_record_id(packet) != record_id) { 337bcf00d8fSMatthias Ringwald record_id = sdp_event_query_attribute_byte_get_record_id(packet); 338bcf00d8fSMatthias Ringwald printf("SDP Record: Nr: %d\n", record_id); 339bcf00d8fSMatthias Ringwald } 340bcf00d8fSMatthias Ringwald 341bcf00d8fSMatthias Ringwald if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= attribute_value_buffer_size) { 342bcf00d8fSMatthias Ringwald attribute_value[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 343bcf00d8fSMatthias Ringwald 344bcf00d8fSMatthias Ringwald if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 345bcf00d8fSMatthias Ringwald 346bcf00d8fSMatthias Ringwald switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 347*235946f1SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_SERVICE_CLASS_ID_LIST: 348bcf00d8fSMatthias Ringwald if (de_get_element_type(attribute_value) != DE_DES) break; 349bcf00d8fSMatthias Ringwald for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) { 350bcf00d8fSMatthias Ringwald uint8_t * element = des_iterator_get_element(&des_list_it); 351bcf00d8fSMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 352bcf00d8fSMatthias Ringwald uint32_t uuid = de_get_uuid32(element); 353bcf00d8fSMatthias Ringwald switch (uuid){ 354*235946f1SMatthias Ringwald case BLUETOOTH_SERVICE_CLASS_PANU: 355*235946f1SMatthias Ringwald case BLUETOOTH_SERVICE_CLASS_NAP: 356*235946f1SMatthias Ringwald case BLUETOOTH_SERVICE_CLASS_GN: 357bcf00d8fSMatthias Ringwald printf("SDP Attribute 0x%04x: BNEP PAN protocol UUID: %04x\n", sdp_event_query_attribute_byte_get_attribute_id(packet), uuid); 358bcf00d8fSMatthias Ringwald bnep_remote_uuid = uuid; 359bcf00d8fSMatthias Ringwald break; 360bcf00d8fSMatthias Ringwald default: 361bcf00d8fSMatthias Ringwald break; 362bcf00d8fSMatthias Ringwald } 363bcf00d8fSMatthias Ringwald } 364bcf00d8fSMatthias Ringwald break; 365bcf00d8fSMatthias Ringwald case 0x0100: 366bcf00d8fSMatthias Ringwald case 0x0101: 367bcf00d8fSMatthias Ringwald str = get_string_from_data_element(attribute_value); 368bcf00d8fSMatthias Ringwald printf("SDP Attribute: 0x%04x: %s\n", sdp_event_query_attribute_byte_get_attribute_id(packet), str); 369bcf00d8fSMatthias Ringwald free(str); 370bcf00d8fSMatthias Ringwald break; 371*235946f1SMatthias Ringwald case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: { 372bcf00d8fSMatthias Ringwald printf("SDP Attribute: 0x%04x\n", sdp_event_query_attribute_byte_get_attribute_id(packet)); 373bcf00d8fSMatthias Ringwald 374bcf00d8fSMatthias Ringwald for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) { 375bcf00d8fSMatthias Ringwald uint8_t *des_element; 376bcf00d8fSMatthias Ringwald uint8_t *element; 377bcf00d8fSMatthias Ringwald uint32_t uuid; 378bcf00d8fSMatthias Ringwald 379bcf00d8fSMatthias Ringwald if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 380bcf00d8fSMatthias Ringwald 381bcf00d8fSMatthias Ringwald des_element = des_iterator_get_element(&des_list_it); 382bcf00d8fSMatthias Ringwald des_iterator_init(&prot_it, des_element); 383bcf00d8fSMatthias Ringwald element = des_iterator_get_element(&prot_it); 384bcf00d8fSMatthias Ringwald 385bcf00d8fSMatthias Ringwald if (de_get_element_type(element) != DE_UUID) continue; 386bcf00d8fSMatthias Ringwald 387bcf00d8fSMatthias Ringwald uuid = de_get_uuid32(element); 388bcf00d8fSMatthias Ringwald switch (uuid){ 389*235946f1SMatthias Ringwald case BLUETOOTH_PROTOCOL_L2CAP: 390bcf00d8fSMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 391bcf00d8fSMatthias Ringwald des_iterator_next(&prot_it); 392bcf00d8fSMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &bnep_l2cap_psm); 393bcf00d8fSMatthias Ringwald break; 394*235946f1SMatthias Ringwald case BLUETOOTH_PROTOCOL_BNEP: 395bcf00d8fSMatthias Ringwald if (!des_iterator_has_more(&prot_it)) continue; 396bcf00d8fSMatthias Ringwald des_iterator_next(&prot_it); 397bcf00d8fSMatthias Ringwald de_element_get_uint16(des_iterator_get_element(&prot_it), &bnep_version); 398bcf00d8fSMatthias Ringwald break; 399bcf00d8fSMatthias Ringwald default: 400bcf00d8fSMatthias Ringwald break; 401bcf00d8fSMatthias Ringwald } 402bcf00d8fSMatthias Ringwald } 403bcf00d8fSMatthias Ringwald printf("l2cap_psm 0x%04x, bnep_version 0x%04x\n", bnep_l2cap_psm, bnep_version); 404bcf00d8fSMatthias Ringwald 405bcf00d8fSMatthias Ringwald /* Create BNEP connection */ 406a224d682SMatthias Ringwald bnep_connect(packet_handler, remote, bnep_l2cap_psm, BLUETOOTH_SERVICE_CLASS_PANU, bnep_remote_uuid); 407bcf00d8fSMatthias Ringwald } 408bcf00d8fSMatthias Ringwald break; 409bcf00d8fSMatthias Ringwald default: 410bcf00d8fSMatthias Ringwald break; 411bcf00d8fSMatthias Ringwald } 412bcf00d8fSMatthias Ringwald } 413bcf00d8fSMatthias Ringwald } else { 414bcf00d8fSMatthias Ringwald fprintf(stderr, "SDP attribute value buffer size exceeded: available %d, required %d\n", attribute_value_buffer_size, sdp_event_query_attribute_byte_get_attribute_length(packet)); 415bcf00d8fSMatthias Ringwald } 416bcf00d8fSMatthias Ringwald break; 417bcf00d8fSMatthias Ringwald 418bcf00d8fSMatthias Ringwald case SDP_EVENT_QUERY_COMPLETE: 419bcf00d8fSMatthias Ringwald fprintf(stderr, "General query done with status %d.\n", sdp_event_query_complete_get_status(packet)); 420bcf00d8fSMatthias Ringwald 421bcf00d8fSMatthias Ringwald break; 422bcf00d8fSMatthias Ringwald } 423bcf00d8fSMatthias Ringwald } 424bcf00d8fSMatthias Ringwald 425bcf00d8fSMatthias Ringwald /* 426bcf00d8fSMatthias Ringwald * @section Packet Handler 427bcf00d8fSMatthias Ringwald * 428bcf00d8fSMatthias Ringwald * @text The packet handler responds to various HCI Events. 429bcf00d8fSMatthias Ringwald */ 430bcf00d8fSMatthias Ringwald 431bcf00d8fSMatthias Ringwald 432bcf00d8fSMatthias Ringwald /* LISTING_START(packetHandler): Packet Handler */ 433bcf00d8fSMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) 434bcf00d8fSMatthias Ringwald { 435bcf00d8fSMatthias Ringwald /* LISTING_PAUSE */ 436c83b0215SMatthias Ringwald UNUSED(channel); 437c83b0215SMatthias Ringwald 438bcf00d8fSMatthias Ringwald int rc; 439bcf00d8fSMatthias Ringwald uint8_t event; 440bcf00d8fSMatthias Ringwald bd_addr_t event_addr; 441bcf00d8fSMatthias Ringwald bd_addr_t local_addr; 442bcf00d8fSMatthias Ringwald uint16_t uuid_source; 443bcf00d8fSMatthias Ringwald uint16_t uuid_dest; 444bcf00d8fSMatthias Ringwald uint16_t mtu; 445bcf00d8fSMatthias Ringwald 446bcf00d8fSMatthias Ringwald /* LISTING_RESUME */ 447bcf00d8fSMatthias Ringwald switch (packet_type) { 448bcf00d8fSMatthias Ringwald case HCI_EVENT_PACKET: 4490e2df43fSMatthias Ringwald event = hci_event_packet_get_type(packet); 450bcf00d8fSMatthias Ringwald switch (event) { 451bcf00d8fSMatthias Ringwald /* @text When BTSTACK_EVENT_STATE with state HCI_STATE_WORKING 452bcf00d8fSMatthias Ringwald * is received and the example is started in client mode, the remote SDP BNEP query is started. 453bcf00d8fSMatthias Ringwald */ 454bcf00d8fSMatthias Ringwald case BTSTACK_EVENT_STATE: 455be7cc9a0SMilanka Ringwald if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){ 456bcf00d8fSMatthias Ringwald printf("Start SDP BNEP query.\n"); 457*235946f1SMatthias Ringwald sdp_client_query_uuid16(&handle_sdp_client_query_result, remote, BLUETOOTH_PROTOCOL_BNEP); 458bcf00d8fSMatthias Ringwald } 459bcf00d8fSMatthias Ringwald break; 460bcf00d8fSMatthias Ringwald 461bcf00d8fSMatthias Ringwald /* LISTING_PAUSE */ 462bcf00d8fSMatthias Ringwald case HCI_EVENT_PIN_CODE_REQUEST: 463bcf00d8fSMatthias Ringwald // inform about pin code request 464bcf00d8fSMatthias Ringwald printf("Pin code request - using '0000'\n"); 465a6ef64baSMilanka Ringwald hci_event_pin_code_request_get_bd_addr(packet, event_addr); 466bcf00d8fSMatthias Ringwald hci_send_cmd(&hci_pin_code_request_reply, &event_addr, 4, "0000"); 467bcf00d8fSMatthias Ringwald break; 468bcf00d8fSMatthias Ringwald 469bcf00d8fSMatthias Ringwald case HCI_EVENT_USER_CONFIRMATION_REQUEST: 470bcf00d8fSMatthias Ringwald // inform about user confirmation request 471bcf00d8fSMatthias Ringwald printf("SSP User Confirmation Request with numeric value '%06u'\n", little_endian_read_32(packet, 8)); 472bcf00d8fSMatthias Ringwald printf("SSP User Confirmation Auto accept\n"); 473bcf00d8fSMatthias Ringwald break; 474bcf00d8fSMatthias Ringwald 475bcf00d8fSMatthias Ringwald /* LISTING_RESUME */ 476bcf00d8fSMatthias Ringwald 477423c667cSMatthias Ringwald /* @text BNEP_EVENT_CHANNEL_OPENED is received after a BNEP connection was established or 478bcf00d8fSMatthias Ringwald * or when the connection fails. The status field returns the error code. 479bcf00d8fSMatthias Ringwald * 480bcf00d8fSMatthias Ringwald * The TAP network interface is then configured. A data source is set up and registered with the 481bcf00d8fSMatthias Ringwald * run loop to receive Ethernet packets from the TAP interface. 482bcf00d8fSMatthias Ringwald * 483bcf00d8fSMatthias Ringwald * The event contains both the source and destination UUIDs, as well as the MTU for this connection and 484bcf00d8fSMatthias Ringwald * the BNEP Channel ID, which is used for sending Ethernet packets over BNEP. 485bcf00d8fSMatthias Ringwald */ 486423c667cSMatthias Ringwald case BNEP_EVENT_CHANNEL_OPENED: 487508c11d6SMilanka Ringwald if (bnep_event_channel_opened_get_status(packet)) { 488508c11d6SMilanka Ringwald printf("BNEP channel open failed, status %02x\n", bnep_event_channel_opened_get_status(packet)); 489bcf00d8fSMatthias Ringwald } else { 490508c11d6SMilanka Ringwald bnep_cid = bnep_event_channel_opened_get_bnep_cid(packet); 491508c11d6SMilanka Ringwald uuid_source = bnep_event_channel_opened_get_source_uuid(packet); 492508c11d6SMilanka Ringwald uuid_dest = bnep_event_channel_opened_get_destination_uuid(packet); 493508c11d6SMilanka Ringwald mtu = bnep_event_channel_opened_get_mtu(packet); 494bcf00d8fSMatthias Ringwald //bt_flip_addr(event_addr, &packet[9]); 495423c667cSMatthias Ringwald memcpy(&event_addr, &packet[11], sizeof(bd_addr_t)); 496bcf00d8fSMatthias Ringwald printf("BNEP connection open succeeded to %s source UUID 0x%04x dest UUID: 0x%04x, max frame size %u\n", bd_addr_to_str(event_addr), uuid_source, uuid_dest, mtu); 497bcf00d8fSMatthias Ringwald /* Create the tap interface */ 498bcf00d8fSMatthias Ringwald gap_local_bd_addr(local_addr); 499bcf00d8fSMatthias Ringwald tap_fd = tap_alloc(tap_dev_name, local_addr); 500bcf00d8fSMatthias Ringwald if (tap_fd < 0) { 501bcf00d8fSMatthias Ringwald printf("Creating BNEP tap device failed: %s\n", strerror(errno)); 502bcf00d8fSMatthias Ringwald } else { 503bcf00d8fSMatthias Ringwald printf("BNEP device \"%s\" allocated.\n", tap_dev_name); 504bcf00d8fSMatthias Ringwald /* Create and register a new runloop data source */ 50580edae71SMatthias Ringwald btstack_run_loop_set_data_source_fd(&tap_dev_ds, tap_fd); 506423c667cSMatthias Ringwald btstack_run_loop_set_data_source_handler(&tap_dev_ds, &process_tap_dev_data); 507bcf00d8fSMatthias Ringwald btstack_run_loop_add_data_source(&tap_dev_ds); 508bcf00d8fSMatthias Ringwald } 509bcf00d8fSMatthias Ringwald } 510bcf00d8fSMatthias Ringwald break; 511bcf00d8fSMatthias Ringwald 512bcf00d8fSMatthias Ringwald /* @text If there is a timeout during the connection setup, BNEP_EVENT_CHANNEL_TIMEOUT will be received 513bcf00d8fSMatthias Ringwald * and the BNEP connection will be closed 514bcf00d8fSMatthias Ringwald */ 515bcf00d8fSMatthias Ringwald case BNEP_EVENT_CHANNEL_TIMEOUT: 516bcf00d8fSMatthias Ringwald printf("BNEP channel timeout! Channel will be closed\n"); 517bcf00d8fSMatthias Ringwald break; 518bcf00d8fSMatthias Ringwald 519bcf00d8fSMatthias Ringwald /* @text BNEP_EVENT_CHANNEL_CLOSED is received when the connection gets closed. 520bcf00d8fSMatthias Ringwald */ 521bcf00d8fSMatthias Ringwald case BNEP_EVENT_CHANNEL_CLOSED: 522bcf00d8fSMatthias Ringwald printf("BNEP channel closed\n"); 523bcf00d8fSMatthias Ringwald btstack_run_loop_remove_data_source(&tap_dev_ds); 524bcf00d8fSMatthias Ringwald if (tap_fd > 0) { 525bcf00d8fSMatthias Ringwald close(tap_fd); 526bcf00d8fSMatthias Ringwald tap_fd = -1; 527bcf00d8fSMatthias Ringwald } 528bcf00d8fSMatthias Ringwald break; 529bcf00d8fSMatthias Ringwald 5302d4c8c04SMatthias Ringwald /* @text BNEP_EVENT_CAN_SEND_NOW indicates that a new packet can be send. This triggers the retry of a 531bcf00d8fSMatthias Ringwald * parked network packet. If this succeeds, the data source element is added to the run loop again. 532bcf00d8fSMatthias Ringwald */ 5332d4c8c04SMatthias Ringwald case BNEP_EVENT_CAN_SEND_NOW: 534bcf00d8fSMatthias Ringwald // Check for parked network packets and send it out now 535bcf00d8fSMatthias Ringwald if (network_buffer_len > 0) { 536bcf00d8fSMatthias Ringwald bnep_send(bnep_cid, network_buffer, network_buffer_len); 537bcf00d8fSMatthias Ringwald network_buffer_len = 0; 538bcf00d8fSMatthias Ringwald // Re-add the tap device data source 539bcf00d8fSMatthias Ringwald btstack_run_loop_add_data_source(&tap_dev_ds); 540bcf00d8fSMatthias Ringwald } 541bcf00d8fSMatthias Ringwald 542bcf00d8fSMatthias Ringwald break; 543bcf00d8fSMatthias Ringwald 544bcf00d8fSMatthias Ringwald default: 545bcf00d8fSMatthias Ringwald break; 546bcf00d8fSMatthias Ringwald } 547bcf00d8fSMatthias Ringwald break; 548bcf00d8fSMatthias Ringwald 549bcf00d8fSMatthias Ringwald /* @text Ethernet packets from the remote device are received in the packet handler with type BNEP_DATA_PACKET. 550bcf00d8fSMatthias Ringwald * It is forwarded to the TAP interface. 551bcf00d8fSMatthias Ringwald */ 552bcf00d8fSMatthias Ringwald case BNEP_DATA_PACKET: 553bcf00d8fSMatthias Ringwald // Write out the ethernet frame to the tap device 554bcf00d8fSMatthias Ringwald if (tap_fd > 0) { 555bcf00d8fSMatthias Ringwald rc = write(tap_fd, packet, size); 556bcf00d8fSMatthias Ringwald if (rc < 0) { 557bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Could not write to TAP device: %s\n", strerror(errno)); 558bcf00d8fSMatthias Ringwald } else 559bcf00d8fSMatthias Ringwald if (rc != size) { 560bcf00d8fSMatthias Ringwald fprintf(stderr, "TAP: Package written only partially %d of %d bytes\n", rc, size); 561bcf00d8fSMatthias Ringwald } 562bcf00d8fSMatthias Ringwald } 563bcf00d8fSMatthias Ringwald break; 564bcf00d8fSMatthias Ringwald 565bcf00d8fSMatthias Ringwald default: 566bcf00d8fSMatthias Ringwald break; 567bcf00d8fSMatthias Ringwald } 568bcf00d8fSMatthias Ringwald } 569bcf00d8fSMatthias Ringwald /* LISTING_END */ 570bcf00d8fSMatthias Ringwald 571bcf00d8fSMatthias Ringwald 572bcf00d8fSMatthias Ringwald int btstack_main(int argc, const char * argv[]); 573bcf00d8fSMatthias Ringwald int btstack_main(int argc, const char * argv[]){ 574bcf00d8fSMatthias Ringwald 575c83b0215SMatthias Ringwald UNUSED(argc); 576c83b0215SMatthias Ringwald UNUSED(argv); 577c83b0215SMatthias Ringwald 578bcf00d8fSMatthias Ringwald printf("Client HCI init done\n"); 579bcf00d8fSMatthias Ringwald 580bcf00d8fSMatthias Ringwald panu_setup(); 581bcf00d8fSMatthias Ringwald // Turn on the device 582bcf00d8fSMatthias Ringwald hci_power_control(HCI_POWER_ON); 583bcf00d8fSMatthias Ringwald return 0; 584bcf00d8fSMatthias Ringwald } 585bcf00d8fSMatthias Ringwald 586bcf00d8fSMatthias Ringwald /* EXAMPLE_END */ 587bcf00d8fSMatthias Ringwald /* -*- Mode: C; indent-tabs-mode: nil; c-basic-offset: 4; tab-width: 4 -*- */ 588bcf00d8fSMatthias Ringwald 589