xref: /btstack/example/sm_pairing_central.c (revision bace42effc5c76e7dcfa3189abae51fe2b9ebfe2)
17c485f8bSMatthias Ringwald /*
27c485f8bSMatthias Ringwald  * Copyright (C) 2014 BlueKitchen GmbH
37c485f8bSMatthias Ringwald  *
47c485f8bSMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
57c485f8bSMatthias Ringwald  * modification, are permitted provided that the following conditions
67c485f8bSMatthias Ringwald  * are met:
77c485f8bSMatthias Ringwald  *
87c485f8bSMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
97c485f8bSMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
107c485f8bSMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
117c485f8bSMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
127c485f8bSMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
137c485f8bSMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
147c485f8bSMatthias Ringwald  *    contributors may be used to endorse or promote products derived
157c485f8bSMatthias Ringwald  *    from this software without specific prior written permission.
167c485f8bSMatthias Ringwald  * 4. Any redistribution, use, or modification is done solely for
177c485f8bSMatthias Ringwald  *    personal benefit and not for any commercial purpose or for
187c485f8bSMatthias Ringwald  *    monetary gain.
197c485f8bSMatthias Ringwald  *
207c485f8bSMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
217c485f8bSMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
227c485f8bSMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
237c485f8bSMatthias Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
247c485f8bSMatthias Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
257c485f8bSMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
267c485f8bSMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
277c485f8bSMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
287c485f8bSMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
297c485f8bSMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
307c485f8bSMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
317c485f8bSMatthias Ringwald  * SUCH DAMAGE.
327c485f8bSMatthias Ringwald  *
337c485f8bSMatthias Ringwald  * Please inquire about commercial licensing options at
347c485f8bSMatthias Ringwald  * [email protected]
357c485f8bSMatthias Ringwald  *
367c485f8bSMatthias Ringwald  */
37ab2c6ae4SMatthias Ringwald 
38ab2c6ae4SMatthias Ringwald #define __BTSTACK_FILE__ "sm_pairing_central.c"
397c485f8bSMatthias Ringwald 
407c485f8bSMatthias Ringwald 
417c485f8bSMatthias Ringwald // *****************************************************************************
427c485f8bSMatthias Ringwald /* EXAMPLE_START(sm_pairing_central): LE Peripheral - Test pairing combinations
437c485f8bSMatthias Ringwald  *
447c485f8bSMatthias Ringwald  * @text Depending on the Authentication requiremens and IO Capabilities,
457c485f8bSMatthias Ringwald  * the pairing process uses different short and long term key generation method.
467c485f8bSMatthias Ringwald  * This example helps explore the different options incl. LE Secure Connections.
477c485f8bSMatthias Ringwald  * It scans for advertisements and connects to the first device that lists a
487c485f8bSMatthias Ringwald  * random service.
497c485f8bSMatthias Ringwald  */
507c485f8bSMatthias Ringwald  // *****************************************************************************
517c485f8bSMatthias Ringwald 
527c485f8bSMatthias Ringwald 
537c485f8bSMatthias Ringwald #include <stdint.h>
547c485f8bSMatthias Ringwald #include <inttypes.h>
557c485f8bSMatthias Ringwald #include <stdio.h>
567c485f8bSMatthias Ringwald #include <stdlib.h>
577c485f8bSMatthias Ringwald #include <string.h>
587c485f8bSMatthias Ringwald 
597c485f8bSMatthias Ringwald #include "btstack.h"
607c485f8bSMatthias Ringwald 
617c485f8bSMatthias Ringwald 
627c485f8bSMatthias Ringwald // We're looking for a remote device that lists this service in the advertisement
637c485f8bSMatthias Ringwald // LightBlue assigns 0x1111 as the UUID for a Blank service.
647c485f8bSMatthias Ringwald #define REMOTE_SERVICE 0x1111
657c485f8bSMatthias Ringwald 
667c485f8bSMatthias Ringwald 
677c485f8bSMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
687c485f8bSMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration;
697c485f8bSMatthias Ringwald 
707c485f8bSMatthias Ringwald /* @section GAP LE setup for receiving advertisements
717c485f8bSMatthias Ringwald  *
727c485f8bSMatthias Ringwald  * @text GAP LE advertisements are received as custom HCI events of the
737c485f8bSMatthias Ringwald  * GAP_EVENT_ADVERTISING_REPORT type. To receive them, you'll need to register
747c485f8bSMatthias Ringwald  * the HCI packet handler, as shown in Listing GAPLEAdvSetup.
757c485f8bSMatthias Ringwald  */
767c485f8bSMatthias Ringwald 
777c485f8bSMatthias Ringwald /* LISTING_START(GAPLEAdvSetup): Setting up GAP LE client for receiving advertisements */
787c485f8bSMatthias Ringwald static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
797c485f8bSMatthias Ringwald 
807c485f8bSMatthias Ringwald static void sm_pairing_central_setup(void){
817c485f8bSMatthias Ringwald     hci_event_callback_registration.callback = &packet_handler;
827c485f8bSMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
837c485f8bSMatthias Ringwald 
847c485f8bSMatthias Ringwald     l2cap_init();
857c485f8bSMatthias Ringwald 
867c485f8bSMatthias Ringwald     // setup le device db
877c485f8bSMatthias Ringwald     le_device_db_init();
887c485f8bSMatthias Ringwald 
897c485f8bSMatthias Ringwald     // setup SM: Display only
907c485f8bSMatthias Ringwald     sm_init();
917c485f8bSMatthias Ringwald     sm_event_callback_registration.callback = &packet_handler;
927c485f8bSMatthias Ringwald     sm_add_event_handler(&sm_event_callback_registration);
937c485f8bSMatthias Ringwald 
947c485f8bSMatthias Ringwald     /**
957c485f8bSMatthias Ringwald      * Choose ONE of the following configurations
967c485f8bSMatthias Ringwald      */
977c485f8bSMatthias Ringwald 
987c485f8bSMatthias Ringwald     // LE Legacy Pairing, Just Works
997c485f8bSMatthias Ringwald     sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
1007c485f8bSMatthias Ringwald     sm_set_authentication_requirements(0);
1017c485f8bSMatthias Ringwald 
1027c485f8bSMatthias Ringwald     // LE Legacy Pairing, Passkey entry initiator enter, responder (us) displays
1037c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_ONLY);
1047c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_MITM_PROTECTION);
1057c485f8bSMatthias Ringwald 
1067c485f8bSMatthias Ringwald #ifdef ENABLE_LE_SECURE_CONNECTIONS
1077c485f8bSMatthias Ringwald     // LE Secure Connetions, Just Works
1087c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
1097c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION);
1107c485f8bSMatthias Ringwald 
1117c485f8bSMatthias Ringwald     // LE Secure Connections, Numeric Comparison
1127c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
1137c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION|SM_AUTHREQ_MITM_PROTECTION);
1147c485f8bSMatthias Ringwald 
1157c485f8bSMatthias Ringwald     // LE Legacy Pairing, Passkey entry initiator enter, responder (us) displays
1167c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_ONLY);
1177c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION|SM_AUTHREQ_MITM_PROTECTION);
1187c485f8bSMatthias Ringwald #endif
1197c485f8bSMatthias Ringwald }
1207c485f8bSMatthias Ringwald 
1217c485f8bSMatthias Ringwald /* LISTING_END */
1227c485f8bSMatthias Ringwald 
1237c485f8bSMatthias Ringwald /* @section HCI packet handler
1247c485f8bSMatthias Ringwald  *
1257c485f8bSMatthias Ringwald  * @text The HCI packet handler has to start the scanning,
1267c485f8bSMatthias Ringwald  * and to handle received advertisements. Advertisements are received
1277c485f8bSMatthias Ringwald  * as HCI event packets of the GAP_EVENT_ADVERTISING_REPORT type,
1287c485f8bSMatthias Ringwald  * see Listing GAPLEAdvPacketHandler.
1297c485f8bSMatthias Ringwald  */
1307c485f8bSMatthias Ringwald 
1317c485f8bSMatthias Ringwald /* LISTING_START(GAPLEAdvPacketHandler): Scanning and receiving advertisements */
1327c485f8bSMatthias Ringwald 
1337c485f8bSMatthias Ringwald static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
1349ec2630cSMatthias Ringwald     UNUSED(channel);
1359ec2630cSMatthias Ringwald     UNUSED(size);
1369ec2630cSMatthias Ringwald 
1377c485f8bSMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
1387c485f8bSMatthias Ringwald     hci_con_handle_t con_handle;
1397c485f8bSMatthias Ringwald 
1407c485f8bSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
1417c485f8bSMatthias Ringwald         case BTSTACK_EVENT_STATE:
1427c485f8bSMatthias Ringwald             // BTstack activated, get started
1437c485f8bSMatthias Ringwald             if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){
1447c485f8bSMatthias Ringwald                 printf("Start scaning!\n");
1457c485f8bSMatthias Ringwald                 gap_set_scan_parameters(1,0x0030, 0x0030);
1467c485f8bSMatthias Ringwald                 gap_start_scan();
1477c485f8bSMatthias Ringwald             }
1487c485f8bSMatthias Ringwald             break;
1497c485f8bSMatthias Ringwald         case GAP_EVENT_ADVERTISING_REPORT:{
1507c485f8bSMatthias Ringwald             bd_addr_t address;
1517c485f8bSMatthias Ringwald             gap_event_advertising_report_get_address(packet, address);
1527c485f8bSMatthias Ringwald             uint8_t address_type = gap_event_advertising_report_get_address_type(packet);
1537c485f8bSMatthias Ringwald             uint8_t length = gap_event_advertising_report_get_data_length(packet);
1547c485f8bSMatthias Ringwald             const uint8_t * data = gap_event_advertising_report_get_data(packet);
1557c485f8bSMatthias Ringwald             printf("Advertisement event: addr-type %u, addr %s, data[%u] ",
1567c485f8bSMatthias Ringwald                address_type, bd_addr_to_str(address), length);
1577c485f8bSMatthias Ringwald             printf_hexdump(data, length);
1587c485f8bSMatthias Ringwald             if (!ad_data_contains_uuid16(length, (uint8_t *) data, REMOTE_SERVICE)) break;
1597c485f8bSMatthias Ringwald             printf("Found remote with UUID %04x, connecting...\n", REMOTE_SERVICE);
1607c485f8bSMatthias Ringwald             gap_stop_scan();
1617c485f8bSMatthias Ringwald             gap_connect(address,address_type);
1627c485f8bSMatthias Ringwald             break;
1637c485f8bSMatthias Ringwald         }
1647c485f8bSMatthias Ringwald         case SM_EVENT_JUST_WORKS_REQUEST:
1657c485f8bSMatthias Ringwald             printf("Just works requested\n");
1667c485f8bSMatthias Ringwald             sm_just_works_confirm(sm_event_just_works_request_get_handle(packet));
1677c485f8bSMatthias Ringwald             break;
1687c485f8bSMatthias Ringwald         case SM_EVENT_NUMERIC_COMPARISON_REQUEST:
169*bace42efSMatthias Ringwald             printf("Confirming numeric comparison: %"PRIu32"\n", sm_event_numeric_comparison_request_get_passkey(packet));
1707c485f8bSMatthias Ringwald             sm_numeric_comparison_confirm(sm_event_passkey_display_number_get_handle(packet));
1717c485f8bSMatthias Ringwald             break;
1727c485f8bSMatthias Ringwald         case SM_EVENT_PASSKEY_DISPLAY_NUMBER:
173*bace42efSMatthias Ringwald             printf("Display Passkey: %"PRIu32"\n", sm_event_passkey_display_number_get_passkey(packet));
1747c485f8bSMatthias Ringwald             break;
1757c485f8bSMatthias Ringwald 
1767c485f8bSMatthias Ringwald         case HCI_EVENT_LE_META:
1777c485f8bSMatthias Ringwald             // wait for connection complete
1787c485f8bSMatthias Ringwald             if (hci_event_le_meta_get_subevent_code(packet) != HCI_SUBEVENT_LE_CONNECTION_COMPLETE) break;
1797c485f8bSMatthias Ringwald             con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet);
1807c485f8bSMatthias Ringwald             // start pairing
1817c485f8bSMatthias Ringwald             sm_request_pairing(con_handle);
1827c485f8bSMatthias Ringwald             break;
1837c485f8bSMatthias Ringwald         default:
1847c485f8bSMatthias Ringwald             break;
1857c485f8bSMatthias Ringwald     }
1867c485f8bSMatthias Ringwald }
1877c485f8bSMatthias Ringwald /* LISTING_END */
1887c485f8bSMatthias Ringwald 
1897c485f8bSMatthias Ringwald int btstack_main(void);
1907c485f8bSMatthias Ringwald int btstack_main(void)
1917c485f8bSMatthias Ringwald {
1927c485f8bSMatthias Ringwald     sm_pairing_central_setup();
1937c485f8bSMatthias Ringwald 
1947c485f8bSMatthias Ringwald     // turn on!
1957c485f8bSMatthias Ringwald     hci_power_control(HCI_POWER_ON);
1967c485f8bSMatthias Ringwald 
1977c485f8bSMatthias Ringwald     return 0;
1987c485f8bSMatthias Ringwald }
1997c485f8bSMatthias Ringwald 
2007c485f8bSMatthias Ringwald /* EXAMPLE_END */
201