From 5c65ab935c23f321890d1e9436cdf3f679e64ffc Mon Sep 17 00:00:00 2001 From: "matthias.ringwald" Date: Sun, 1 May 2011 11:34:07 +0000 Subject: [PATCH] added rfcomm-echo example --- example/Makefile.in | 2 +- example/rfcomm-cat.c | 124 +---------------------- example/rfcomm-echo.c | 224 ++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 229 insertions(+), 121 deletions(-) create mode 100644 example/rfcomm-echo.c diff --git a/example/Makefile.in b/example/Makefile.in index 6ba3b7b7f..b204f5da7 100644 --- a/example/Makefile.in +++ b/example/Makefile.in @@ -3,7 +3,7 @@ LDFLAGS = @LDFLAGS@ -lBTstack -L../src CPPFLAGS = @CPPFLAGS@ -I../include prefix = @prefix@ -all: test mitm rfcomm-cat inquiry l2cap-server l2cap-throughput +all: test mitm rfcomm-cat rfcomm-echo inquiry l2cap-server l2cap-throughput test: test.c $(CC) $(CPPFLAGS) -o $@ $< $(LDFLAGS) diff --git a/example/rfcomm-cat.c b/example/rfcomm-cat.c index a79164240..6852b2aca 100644 --- a/example/rfcomm-cat.c +++ b/example/rfcomm-cat.c @@ -83,24 +83,10 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint break; case BTSTACK_EVENT_STATE: - // bt stack activated, get started - use authentication yes/no - if (packet[2] == HCI_STATE_WORKING) { - bt_send_cmd(&hci_write_class_of_device, 0x1f00); - } - break; - - case HCI_EVENT_COMMAND_COMPLETE: - // connect to RFCOMM device (PSM 0x03) at addr - if ( COMMAND_COMPLETE_EVENT(packet, hci_write_class_of_device) ) { - // outgoing only: + // bt stack activated, get started + if (packet[2] == HCI_STATE_WORKING) { bt_send_cmd(&rfcomm_create_channel, addr, rfcomm_channel); } - if ( COMMAND_COMPLETE_EVENT(packet, hci_read_bd_addr) ) { - bt_flip_addr(event_addr, &packet[6]); - printf("Own BD_ADDR: "); - print_bd_addr(event_addr); - printf("\n"); - } break; case HCI_EVENT_PIN_CODE_REQUEST: @@ -109,18 +95,7 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint bt_flip_addr(event_addr, &packet[2]); bt_send_cmd(&hci_pin_code_request_reply, &event_addr, 4, "0000"); break; - - case RFCOMM_EVENT_INCOMING_CONNECTION: - // data: event (8), len(8), address(48), channel (8), rfcomm_cid (16) - bt_flip_addr(event_addr, &packet[2]); - rfcomm_channel_nr = packet[8]; - rfcomm_channel_id = READ_BT_16(packet, 9); - printf("RFCOMM channel %u requested for ", rfcomm_channel_nr); - print_bd_addr(event_addr); - printf("\n"); - bt_send_cmd(&rfcomm_accept_connection, rfcomm_channel_id); - break; - + case RFCOMM_EVENT_OPEN_CHANNEL_COMPLETE: // data: event(8), len(8), status (8), address (48), server channel(8), rfcomm_cid(16), max frame size(16) if (packet[2]) { @@ -134,16 +109,6 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint } break; - case RFCOMM_EVENT_CREDITS: - // how many? for whom? - rfcomm_channel_id = READ_BT_16(packet, 2); - credits = packet[4]; - // - packet_counter++; - sprintf(packet_info, "\rPacket counter: %09u", packet_counter); - bt_send_rfcomm(rfcomm_channel_id, packet_info, strlen(packet_info)); - break; - case HCI_EVENT_DISCONNECTION_COMPLETE: // connection closed -> quit test app printf("Basebank connection closed\n"); @@ -162,79 +127,8 @@ void usage(const char *name){ fprintf(stderr, "Usage : %s [-a|--address aa:bb:cc:dd:ee:ff] [-c|--channel n] [-p|--pin nnnn]\n", name); } -uint8_t service_buffer[100]; - -void create_spp_service(uint8_t *service){ - - uint8_t* attribute; - de_create_sequence(service); - - // 0x0001 "Service Class ID List" - de_add_number(service, DE_UINT, DE_SIZE_16, 0x0001); - attribute = de_push_sequence(service); - { - de_add_number(attribute, DE_UUID, DE_SIZE_16, 0x1101 ); - } - de_pop_sequence(service, attribute); - - // 0x0004 "Protocol Descriptor List" - de_add_number(service, DE_UINT, DE_SIZE_16, 0x0004); - attribute = de_push_sequence(service); - { - uint8_t* l2cpProtocol = de_push_sequence(attribute); - { - de_add_number(l2cpProtocol, DE_UUID, DE_SIZE_16, 0x0100); - } - de_pop_sequence(attribute, l2cpProtocol); - - uint8_t* rfcomm = de_push_sequence(attribute); - { - de_add_number(rfcomm, DE_UUID, DE_SIZE_16, 0x0003); // rfcomm_service - de_add_number(rfcomm, DE_UINT, DE_SIZE_8, 0x0001); // rfcomm channel - } - de_pop_sequence(attribute, rfcomm); - } - de_pop_sequence(service, attribute); - - // 0x0005 "Public Browse Group" - de_add_number(service, DE_UINT, DE_SIZE_16, 0x0005); // public browse group - attribute = de_push_sequence(service); - { - de_add_number(attribute, DE_UUID, DE_SIZE_16, 0x1002 ); - } - de_pop_sequence(service, attribute); - - // 0x0006 - de_add_number(service, DE_UINT, DE_SIZE_16, SDP_LanguageBaseAttributeIDList); - attribute = de_push_sequence(service); - { - de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x656e); - de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x006a); - de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x0100); - } - de_pop_sequence(service, attribute); - - // 0x0009 "Bluetooth Profile Descriptor List" - de_add_number(service, DE_UINT, DE_SIZE_16, 0x0009); - attribute = de_push_sequence(service); - { - uint8_t *sppProfile = de_push_sequence(attribute); - { - de_add_number(sppProfile, DE_UUID, DE_SIZE_16, 0x1101); - de_add_number(sppProfile, DE_UINT, DE_SIZE_16, 0x0100); - } - de_pop_sequence(attribute, sppProfile); - } - de_pop_sequence(service, attribute); - - // 0x0100 "ServiceName" - de_add_number(service, DE_UINT, DE_SIZE_16, 0x0100); - de_add_data(service, DE_STRING, 3, (uint8_t *) "CMD"); -} - int main (int argc, const char * argv[]){ -#if 1 int arg = 1; if (argc == 1){ @@ -269,7 +163,6 @@ int main (int argc, const char * argv[]){ } arg++; } -#endif run_loop_init(RUN_LOOP_POSIX); int err = bt_open(); @@ -279,19 +172,10 @@ int main (int argc, const char * argv[]){ } bt_register_packet_handler(packet_handler); -#if 1 printf("Trying connection to "); print_bd_addr(addr); printf(" channel %d\n", rfcomm_channel); -#endif - - // register RFCOM channel - bt_send_cmd(&rfcomm_register_service, 1, 100); - - // register SDP for our SPP - create_spp_service(service_buffer); - bt_send_cmd(&sdp_register_service_record, service_buffer); - + bt_send_cmd(&btstack_set_power_mode, HCI_POWER_ON ); run_loop_execute(); bt_close(); diff --git a/example/rfcomm-echo.c b/example/rfcomm-echo.c new file mode 100644 index 000000000..100411b25 --- /dev/null +++ b/example/rfcomm-echo.c @@ -0,0 +1,224 @@ +/* + * Copyright (C) 2010 by Matthias Ringwald + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the copyright holders nor the names of + * contributors may be used to endorse or promote products derived + * from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS + * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS + * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, + * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF + * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + */ + +/* + * rfcomm-echo.c + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +// input from command line arguments +bd_addr_t addr = { }; +uint16_t con_handle; +int rfcomm_channel = 1; +char pin[17]; + +void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ + bd_addr_t event_addr; + uint16_t mtu; + uint16_t psm; + uint16_t rfcomm_channel_id; + uint16_t rfcomm_channel_nr; + uint8_t credits; + static uint32_t packet_counter = 0; + static char packet_info[30]; // "packets: 1234567890" + + switch (packet_type) { + + case RFCOMM_DATA_PACKET: + printf("Received RFCOMM data on channel id %u, size %u\n", channel, size); + hexdump(packet, size); + bt_send_rfcomm(channel, packet, size); + break; + + case HCI_EVENT_PACKET: + switch (packet[0]) { + + case BTSTACK_EVENT_POWERON_FAILED: + // handle HCI init failure + printf("HCI Init failed - make sure you have turned off Bluetooth in the System Settings\n"); + exit(1); + break; + + case BTSTACK_EVENT_STATE: + // bt stack activated, get started + if (packet[2] == HCI_STATE_WORKING) { + bt_send_cmd(&btstack_set_discoverable, 1); + } + break; + + case HCI_EVENT_PIN_CODE_REQUEST: + // inform about pin code request + printf("Using PIN 0000\n"); + bt_flip_addr(event_addr, &packet[2]); + bt_send_cmd(&hci_pin_code_request_reply, &event_addr, 4, "0000"); + break; + + case RFCOMM_EVENT_INCOMING_CONNECTION: + // data: event (8), len(8), address(48), channel (8), rfcomm_cid (16) + bt_flip_addr(event_addr, &packet[2]); + rfcomm_channel_nr = packet[8]; + rfcomm_channel_id = READ_BT_16(packet, 9); + printf("RFCOMM channel %u requested for ", rfcomm_channel_nr); + print_bd_addr(event_addr); + printf("\n"); + bt_send_cmd(&rfcomm_accept_connection, rfcomm_channel_id); + break; + + case RFCOMM_EVENT_OPEN_CHANNEL_COMPLETE: + // data: event(8), len(8), status (8), address (48), server channel(8), rfcomm_cid(16), max frame size(16) + if (packet[2]) { + printf("RFCOMM channel open failed, status %u\n", packet[2]); + } else { + rfcomm_channel_id = READ_BT_16(packet, 10); + mtu = READ_BT_16(packet, 12); + printf("RFCOMM channel open succeeded. New RFCOMM Channel ID %u, max frame size %u\n", rfcomm_channel_id, mtu); + uint8_t message[] = "Hello World from BTstack!\n"; + // bt_send_rfcomm(rfcomm_channel_id, message, sizeof(message)); + } + break; + + case HCI_EVENT_DISCONNECTION_COMPLETE: + // connection closed -> quit test app + printf("Basebank connection closed\n"); + break; + + default: + break; + } + break; + default: + break; + } +} + +uint8_t service_buffer[100]; +void create_spp_service(uint8_t *service){ + + uint8_t* attribute; + de_create_sequence(service); + + // 0x0001 "Service Class ID List" + de_add_number(service, DE_UINT, DE_SIZE_16, 0x0001); + attribute = de_push_sequence(service); + { + de_add_number(attribute, DE_UUID, DE_SIZE_16, 0x1101 ); + } + de_pop_sequence(service, attribute); + + // 0x0004 "Protocol Descriptor List" + de_add_number(service, DE_UINT, DE_SIZE_16, 0x0004); + attribute = de_push_sequence(service); + { + uint8_t* l2cpProtocol = de_push_sequence(attribute); + { + de_add_number(l2cpProtocol, DE_UUID, DE_SIZE_16, 0x0100); + } + de_pop_sequence(attribute, l2cpProtocol); + + uint8_t* rfcomm = de_push_sequence(attribute); + { + de_add_number(rfcomm, DE_UUID, DE_SIZE_16, 0x0003); // rfcomm_service + de_add_number(rfcomm, DE_UINT, DE_SIZE_8, 0x0001); // rfcomm channel + } + de_pop_sequence(attribute, rfcomm); + } + de_pop_sequence(service, attribute); + + // 0x0005 "Public Browse Group" + de_add_number(service, DE_UINT, DE_SIZE_16, 0x0005); // public browse group + attribute = de_push_sequence(service); + { + de_add_number(attribute, DE_UUID, DE_SIZE_16, 0x1002 ); + } + de_pop_sequence(service, attribute); + + // 0x0006 + de_add_number(service, DE_UINT, DE_SIZE_16, SDP_LanguageBaseAttributeIDList); + attribute = de_push_sequence(service); + { + de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x656e); + de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x006a); + de_add_number(attribute, DE_UINT, DE_SIZE_16, 0x0100); + } + de_pop_sequence(service, attribute); + + // 0x0009 "Bluetooth Profile Descriptor List" + de_add_number(service, DE_UINT, DE_SIZE_16, 0x0009); + attribute = de_push_sequence(service); + { + uint8_t *sppProfile = de_push_sequence(attribute); + { + de_add_number(sppProfile, DE_UUID, DE_SIZE_16, 0x1101); + de_add_number(sppProfile, DE_UINT, DE_SIZE_16, 0x0100); + } + de_pop_sequence(attribute, sppProfile); + } + de_pop_sequence(service, attribute); + + // 0x0100 "ServiceName" + de_add_number(service, DE_UINT, DE_SIZE_16, 0x0100); + de_add_data(service, DE_STRING, 3, (uint8_t *) "SPP ECHO"); +} + +int main (int argc, const char * argv[]){ + + run_loop_init(RUN_LOOP_POSIX); + int err = bt_open(); + if (err) { + fprintf(stderr,"Failed to open connection to BTdaemon, err %d\n",err); + return 1; + } + bt_register_packet_handler(packet_handler); + + // register RFCOM channel + bt_send_cmd(&rfcomm_register_service, 1, 100); + + // register SDP for our SPP + create_spp_service(service_buffer); + bt_send_cmd(&sdp_register_service_record, service_buffer); + + bt_send_cmd(&btstack_set_power_mode, HCI_POWER_ON ); + run_loop_execute(); + bt_close(); + return 0; +}