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 * [email protected] 35 * 36 */ 37 38 #define __BTSTACK_FILE__ "sdp_rfcomm_query.c" 39 40 // ***************************************************************************** 41 // 42 // minimal setup for SDP client over USB or UART 43 // 44 // ***************************************************************************** 45 46 #include "btstack_config.h" 47 48 #include <stdint.h> 49 #include <stdio.h> 50 #include <stdlib.h> 51 #include <string.h> 52 53 54 #include "hci_cmd.h" 55 #include "btstack_run_loop.h" 56 57 #include "btstack.h" 58 59 #define NUM_SERVICES 10 60 61 static void handle_query_rfcomm_event(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 62 63 // static bd_addr_t remote = {0x04,0x0C,0xCE,0xE4,0x85,0xD3}; 64 static bd_addr_t remote = {0x84, 0x38, 0x35, 0x65, 0xD1, 0x15}; 65 66 static struct { 67 uint8_t channel_nr; 68 char service_name[SDP_SERVICE_NAME_LEN+1]; 69 } services[NUM_SERVICES]; 70 71 static uint8_t service_index = 0; 72 73 static btstack_packet_callback_registration_t hci_event_callback_registration; 74 75 76 static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 77 UNUSED(channel); 78 UNUSED(size); 79 80 if (packet_type != HCI_EVENT_PACKET) return; 81 uint8_t event = hci_event_packet_get_type(packet); 82 83 switch (event) { 84 case BTSTACK_EVENT_STATE: 85 // BTstack activated, get started 86 if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){ 87 sdp_client_query_rfcomm_channel_and_name_for_uuid(&handle_query_rfcomm_event, remote, BLUETOOTH_ATTRIBUTE_PUBLIC_BROWSE_ROOT); 88 } 89 break; 90 default: 91 break; 92 } 93 } 94 95 static void store_found_service(const char * name, uint8_t port){ 96 printf("APP: Service name: '%s', RFCOMM port %u\n", name, port); 97 if (service_index < NUM_SERVICES){ 98 services[service_index].channel_nr = port; 99 strncpy(services[service_index].service_name, (char*) name, SDP_SERVICE_NAME_LEN); 100 services[service_index].service_name[SDP_SERVICE_NAME_LEN] = 0; 101 service_index++; 102 } else { 103 printf("APP: list full - ignore\n"); 104 return; 105 } 106 } 107 108 static void report_found_services(void){ 109 printf("\n *** Client query response done. "); 110 if (service_index == 0){ 111 printf("No service found.\n\n"); 112 } else { 113 printf("Found following %d services:\n", service_index); 114 } 115 int i; 116 for (i=0; i<service_index; i++){ 117 printf(" Service name %s, RFCOMM port %u\n", services[i].service_name, services[i].channel_nr); 118 } 119 printf(" ***\n\n"); 120 } 121 122 static void handle_query_rfcomm_event(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 123 UNUSED(packet_type); 124 UNUSED(channel); 125 UNUSED(size); 126 127 switch (packet[0]){ 128 case SDP_EVENT_QUERY_RFCOMM_SERVICE: 129 store_found_service(sdp_event_query_rfcomm_service_get_name(packet), 130 sdp_event_query_rfcomm_service_get_rfcomm_channel(packet)); 131 break; 132 case SDP_EVENT_QUERY_COMPLETE: 133 if (sdp_event_query_complete_get_status(packet)){ 134 printf("SDP query failed 0x%02x\n", sdp_event_query_complete_get_status(packet)); 135 break; 136 } 137 printf("SDP query done.\n"); 138 report_found_services(); 139 break; 140 } 141 } 142 143 int btstack_main(int argc, const char * argv[]); 144 int btstack_main(int argc, const char * argv[]){ 145 (void)argc; 146 (void)argv; 147 148 // init L2CAP 149 l2cap_init(); 150 151 // register for HCI events 152 hci_event_callback_registration.callback = &packet_handler; 153 hci_add_event_handler(&hci_event_callback_registration); 154 155 // turn on! 156 hci_power_control(HCI_POWER_ON); 157 158 return 0; 159 } 160