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 BLUEKITCHEN
24 * GMBH 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__ "rfcomm_test.c"
39
40 /*
41 * rfcomm_echo.c
42 */
43
44 #include <unistd.h>
45 #include <stdio.h>
46 #include <stdlib.h>
47 #include <strings.h>
48 #include <errno.h>
49 #include <string.h>
50 #include <fcntl.h>
51 #include <sys/types.h>
52 #include <sys/stat.h>
53
54 #include "btstack_client.h"
55 #include "classic/sdp_util.h"
56
57 #ifdef _WIN32
58 #include "btstack_run_loop_windows.h"
59 #else
60 #include "btstack_run_loop_posix.h"
61 #endif
62
63 #define NUM_ROWS 25
64 #define NUM_COLS 80
65
66 // input from command line arguments
67 bd_addr_t addr = { };
68 hci_con_handle_t con_handle;
69 char pin[17];
70 int counter = 0;
71 uint16_t rfcomm_channel_id = 0;
72 uint16_t mtu = 0;
73 static uint8_t spp_service_buffer[150];
74 uint8_t test_data[NUM_ROWS * NUM_COLS + 1];
75
create_test_data(void)76 void create_test_data(void){
77 int x,y;
78 for (y=0;y<NUM_ROWS;y++){
79 for (x=0;x<NUM_COLS-2;x++){
80 test_data[y*NUM_COLS+x] = '0' + (x % 10);
81 }
82 test_data[y*NUM_COLS+NUM_COLS-2] = '\n';
83 test_data[y*NUM_COLS+NUM_COLS-1] = '\r';
84 }
85 test_data[NUM_COLS*NUM_ROWS] = 0;
86 }
87
packet_handler(uint8_t packet_type,uint16_t channel,uint8_t * packet,uint16_t size)88 void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
89 bd_addr_t event_addr;
90 uint16_t rfcomm_channel_nr;
91
92 switch (packet_type) {
93
94 case RFCOMM_DATA_PACKET:
95 printf("Received RFCOMM data on channel id %u, size %u\n", channel, size);
96 printf_hexdump(packet, size);
97 bt_send_rfcomm(channel, packet, size);
98 break;
99
100 case HCI_EVENT_PACKET:
101 switch (hci_event_packet_get_type(packet)) {
102
103 case BTSTACK_EVENT_POWERON_FAILED:
104 // handle HCI init failure
105 printf("HCI Init failed - make sure you have turned off Bluetooth in the System Settings\n");
106 exit(1);
107 break;
108
109 case BTSTACK_EVENT_STATE:
110 // bt stack activated, get started
111 if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){
112 // get persistent RFCOMM channel
113 printf("HCI_STATE_WORKING\n");
114 bt_send_cmd(&rfcomm_persistent_channel_for_service_cmd, "ch.ringwald.btstack.rfcomm_test");
115 }
116 break;
117
118 case DAEMON_EVENT_RFCOMM_PERSISTENT_CHANNEL:
119 rfcomm_channel_nr = packet[3];
120 printf("RFCOMM channel %u was assigned by BTdaemon\n", rfcomm_channel_nr);
121 bt_send_cmd(&rfcomm_register_service_cmd, rfcomm_channel_nr, 0xffff); // reserved channel, mtu limited by l2cap
122 break;
123
124 case DAEMON_EVENT_RFCOMM_SERVICE_REGISTERED:
125 printf("DAEMON_EVENT_RFCOMM_SERVICE_REGISTERED\n");
126 rfcomm_channel_nr = packet[3];
127 // register SDP for our SPP
128 spp_create_sdp_record((uint8_t*) spp_service_buffer, 0x10001, rfcomm_channel_nr, "RFCOMM Test");
129 bt_send_cmd(&sdp_register_service_record_cmd, spp_service_buffer);
130 bt_send_cmd(&btstack_set_discoverable, 1);
131 break;
132
133 case HCI_EVENT_PIN_CODE_REQUEST:
134 // inform about pin code request
135 printf("Using PIN 0000\n");
136 hci_event_pin_code_request_get_bd_addr(packet, event_addr);
137 bt_send_cmd(&hci_pin_code_request_reply, &event_addr, 4, "0000");
138 break;
139
140 case RFCOMM_EVENT_INCOMING_CONNECTION:
141 // data: event (8), len(8), address(48), channel (8), rfcomm_cid (16)
142 rfcomm_event_incoming_connection_get_bd_addr(packet, event_addr);
143 rfcomm_channel_nr = rfcomm_event_incoming_connection_get_server_channel(packet);
144 rfcomm_channel_id = rfcomm_event_incoming_connection_get_rfcomm_cid(packet);
145 printf("RFCOMM channel %u requested for %s\n", rfcomm_channel_nr, bd_addr_to_str(event_addr));
146 bt_send_cmd(&rfcomm_accept_connection_cmd, rfcomm_channel_id);
147 break;
148
149 case RFCOMM_EVENT_CHANNEL_OPENED:
150 // data: event(8), len(8), status (8), address (48), server channel(8), rfcomm_cid(16), max frame size(16)
151 if (rfcomm_event_channel_opened_get_status(packet)) {
152 printf("RFCOMM channel open failed, status %u\n", rfcomm_event_channel_opened_get_status(packet));
153 } else {
154 rfcomm_channel_id = rfcomm_event_channel_opened_get_rfcomm_cid(packet);
155 mtu = rfcomm_event_channel_opened_get_max_frame_size(packet);
156 printf("RFCOMM channel open succeeded. New RFCOMM Channel ID %u, max frame size %u\n", rfcomm_channel_id, mtu);
157 }
158 break;
159
160 case HCI_EVENT_DISCONNECTION_COMPLETE:
161 // connection closed -> quit test app
162 printf("Basebank connection closed\n");
163 break;
164
165 default:
166 break;
167 }
168 break;
169 default:
170 break;
171 }
172 }
173
174
main(int argc,const char * argv[])175 int main (int argc, const char * argv[]){
176
177 create_test_data();
178 printf("created test data: \n%s\n", test_data);
179
180 #ifdef _WIN32
181 btstack_run_loop_init(btstack_run_loop_windows_get_instance());
182 #else
183 btstack_run_loop_init(btstack_run_loop_posix_get_instance());
184 #endif
185 int err = bt_open();
186 if (err) {
187 fprintf(stderr,"Failed to open connection to BTdaemon, err %d\n",err);
188 return 1;
189 }
190 bt_register_packet_handler(packet_handler);
191
192 bt_send_cmd(&btstack_set_power_mode, HCI_POWER_ON );
193 btstack_run_loop_execute();
194 bt_close();
195 return 0;
196 }
197