xref: /btstack/example/panu_demo.c (revision 235946f152c66eb4ba735043adb492f7a538d15c)
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