xref: /btstack/example/sm_pairing_central.c (revision 9ec2630ce4bfd36adcb438d2e8ba6fc26890f857)
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  */
377c485f8bSMatthias Ringwald 
387c485f8bSMatthias Ringwald 
397c485f8bSMatthias Ringwald // *****************************************************************************
407c485f8bSMatthias Ringwald /* EXAMPLE_START(sm_pairing_central): LE Peripheral - Test pairing combinations
417c485f8bSMatthias Ringwald  *
427c485f8bSMatthias Ringwald  * @text Depending on the Authentication requiremens and IO Capabilities,
437c485f8bSMatthias Ringwald  * the pairing process uses different short and long term key generation method.
447c485f8bSMatthias Ringwald  * This example helps explore the different options incl. LE Secure Connections.
457c485f8bSMatthias Ringwald  * It scans for advertisements and connects to the first device that lists a
467c485f8bSMatthias Ringwald  * random service.
477c485f8bSMatthias Ringwald  */
487c485f8bSMatthias Ringwald  // *****************************************************************************
497c485f8bSMatthias Ringwald 
507c485f8bSMatthias Ringwald 
517c485f8bSMatthias Ringwald #include <stdint.h>
527c485f8bSMatthias Ringwald #include <inttypes.h>
537c485f8bSMatthias Ringwald #include <stdio.h>
547c485f8bSMatthias Ringwald #include <stdlib.h>
557c485f8bSMatthias Ringwald #include <string.h>
567c485f8bSMatthias Ringwald 
577c485f8bSMatthias Ringwald #include "btstack.h"
587c485f8bSMatthias Ringwald 
597c485f8bSMatthias Ringwald 
607c485f8bSMatthias Ringwald // We're looking for a remote device that lists this service in the advertisement
617c485f8bSMatthias Ringwald // LightBlue assigns 0x1111 as the UUID for a Blank service.
627c485f8bSMatthias Ringwald #define REMOTE_SERVICE 0x1111
637c485f8bSMatthias Ringwald 
647c485f8bSMatthias Ringwald 
657c485f8bSMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration;
667c485f8bSMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration;
677c485f8bSMatthias Ringwald 
687c485f8bSMatthias Ringwald /* @section GAP LE setup for receiving advertisements
697c485f8bSMatthias Ringwald  *
707c485f8bSMatthias Ringwald  * @text GAP LE advertisements are received as custom HCI events of the
717c485f8bSMatthias Ringwald  * GAP_EVENT_ADVERTISING_REPORT type. To receive them, you'll need to register
727c485f8bSMatthias Ringwald  * the HCI packet handler, as shown in Listing GAPLEAdvSetup.
737c485f8bSMatthias Ringwald  */
747c485f8bSMatthias Ringwald 
757c485f8bSMatthias Ringwald /* LISTING_START(GAPLEAdvSetup): Setting up GAP LE client for receiving advertisements */
767c485f8bSMatthias Ringwald static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
777c485f8bSMatthias Ringwald 
787c485f8bSMatthias Ringwald static void sm_pairing_central_setup(void){
797c485f8bSMatthias Ringwald     hci_event_callback_registration.callback = &packet_handler;
807c485f8bSMatthias Ringwald     hci_add_event_handler(&hci_event_callback_registration);
817c485f8bSMatthias Ringwald 
827c485f8bSMatthias Ringwald     l2cap_init();
837c485f8bSMatthias Ringwald 
847c485f8bSMatthias Ringwald     // setup le device db
857c485f8bSMatthias Ringwald     le_device_db_init();
867c485f8bSMatthias Ringwald 
877c485f8bSMatthias Ringwald     // setup SM: Display only
887c485f8bSMatthias Ringwald     sm_init();
897c485f8bSMatthias Ringwald     sm_event_callback_registration.callback = &packet_handler;
907c485f8bSMatthias Ringwald     sm_add_event_handler(&sm_event_callback_registration);
917c485f8bSMatthias Ringwald 
927c485f8bSMatthias Ringwald     /**
937c485f8bSMatthias Ringwald      * Choose ONE of the following configurations
947c485f8bSMatthias Ringwald      */
957c485f8bSMatthias Ringwald 
967c485f8bSMatthias Ringwald     // LE Legacy Pairing, Just Works
977c485f8bSMatthias Ringwald     sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
987c485f8bSMatthias Ringwald     sm_set_authentication_requirements(0);
997c485f8bSMatthias Ringwald 
1007c485f8bSMatthias Ringwald     // LE Legacy Pairing, Passkey entry initiator enter, responder (us) displays
1017c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_ONLY);
1027c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_MITM_PROTECTION);
1037c485f8bSMatthias Ringwald 
1047c485f8bSMatthias Ringwald #ifdef ENABLE_LE_SECURE_CONNECTIONS
1057c485f8bSMatthias Ringwald     // LE Secure Connetions, Just Works
1067c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
1077c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION);
1087c485f8bSMatthias Ringwald 
1097c485f8bSMatthias Ringwald     // LE Secure Connections, Numeric Comparison
1107c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_YES_NO);
1117c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION|SM_AUTHREQ_MITM_PROTECTION);
1127c485f8bSMatthias Ringwald 
1137c485f8bSMatthias Ringwald     // LE Legacy Pairing, Passkey entry initiator enter, responder (us) displays
1147c485f8bSMatthias Ringwald     // sm_set_io_capabilities(IO_CAPABILITY_DISPLAY_ONLY);
1157c485f8bSMatthias Ringwald     // sm_set_authentication_requirements(SM_AUTHREQ_SECURE_CONNECTION|SM_AUTHREQ_MITM_PROTECTION);
1167c485f8bSMatthias Ringwald #endif
1177c485f8bSMatthias Ringwald }
1187c485f8bSMatthias Ringwald 
1197c485f8bSMatthias Ringwald /* LISTING_END */
1207c485f8bSMatthias Ringwald 
1217c485f8bSMatthias Ringwald /* @section HCI packet handler
1227c485f8bSMatthias Ringwald  *
1237c485f8bSMatthias Ringwald  * @text The HCI packet handler has to start the scanning,
1247c485f8bSMatthias Ringwald  * and to handle received advertisements. Advertisements are received
1257c485f8bSMatthias Ringwald  * as HCI event packets of the GAP_EVENT_ADVERTISING_REPORT type,
1267c485f8bSMatthias Ringwald  * see Listing GAPLEAdvPacketHandler.
1277c485f8bSMatthias Ringwald  */
1287c485f8bSMatthias Ringwald 
1297c485f8bSMatthias Ringwald /* LISTING_START(GAPLEAdvPacketHandler): Scanning and receiving advertisements */
1307c485f8bSMatthias Ringwald 
1317c485f8bSMatthias Ringwald static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
132*9ec2630cSMatthias Ringwald     UNUSED(channel);
133*9ec2630cSMatthias Ringwald     UNUSED(size);
134*9ec2630cSMatthias Ringwald 
1357c485f8bSMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
1367c485f8bSMatthias Ringwald     hci_con_handle_t con_handle;
1377c485f8bSMatthias Ringwald 
1387c485f8bSMatthias Ringwald     switch (hci_event_packet_get_type(packet)) {
1397c485f8bSMatthias Ringwald         case BTSTACK_EVENT_STATE:
1407c485f8bSMatthias Ringwald             // BTstack activated, get started
1417c485f8bSMatthias Ringwald             if (btstack_event_state_get_state(packet) == HCI_STATE_WORKING){
1427c485f8bSMatthias Ringwald                 printf("Start scaning!\n");
1437c485f8bSMatthias Ringwald                 gap_set_scan_parameters(1,0x0030, 0x0030);
1447c485f8bSMatthias Ringwald                 gap_start_scan();
1457c485f8bSMatthias Ringwald             }
1467c485f8bSMatthias Ringwald             break;
1477c485f8bSMatthias Ringwald         case GAP_EVENT_ADVERTISING_REPORT:{
1487c485f8bSMatthias Ringwald             bd_addr_t address;
1497c485f8bSMatthias Ringwald             gap_event_advertising_report_get_address(packet, address);
1507c485f8bSMatthias Ringwald             uint8_t address_type = gap_event_advertising_report_get_address_type(packet);
1517c485f8bSMatthias Ringwald             uint8_t length = gap_event_advertising_report_get_data_length(packet);
1527c485f8bSMatthias Ringwald             const uint8_t * data = gap_event_advertising_report_get_data(packet);
1537c485f8bSMatthias Ringwald             printf("Advertisement event: addr-type %u, addr %s, data[%u] ",
1547c485f8bSMatthias Ringwald                address_type, bd_addr_to_str(address), length);
1557c485f8bSMatthias Ringwald             printf_hexdump(data, length);
1567c485f8bSMatthias Ringwald             if (!ad_data_contains_uuid16(length, (uint8_t *) data, REMOTE_SERVICE)) break;
1577c485f8bSMatthias Ringwald             printf("Found remote with UUID %04x, connecting...\n", REMOTE_SERVICE);
1587c485f8bSMatthias Ringwald             gap_stop_scan();
1597c485f8bSMatthias Ringwald             gap_connect(address,address_type);
1607c485f8bSMatthias Ringwald             break;
1617c485f8bSMatthias Ringwald         }
1627c485f8bSMatthias Ringwald         case SM_EVENT_JUST_WORKS_REQUEST:
1637c485f8bSMatthias Ringwald             printf("Just works requested\n");
1647c485f8bSMatthias Ringwald             sm_just_works_confirm(sm_event_just_works_request_get_handle(packet));
1657c485f8bSMatthias Ringwald             break;
1667c485f8bSMatthias Ringwald         case SM_EVENT_NUMERIC_COMPARISON_REQUEST:
1677c485f8bSMatthias Ringwald             printf("Confirming numeric comparison: %u\n", sm_event_numeric_comparison_request_get_passkey(packet));
1687c485f8bSMatthias Ringwald             sm_numeric_comparison_confirm(sm_event_passkey_display_number_get_handle(packet));
1697c485f8bSMatthias Ringwald             break;
1707c485f8bSMatthias Ringwald         case SM_EVENT_PASSKEY_DISPLAY_NUMBER:
1717c485f8bSMatthias Ringwald             printf("Display Passkey: %u\n", sm_event_passkey_display_number_get_passkey(packet));
1727c485f8bSMatthias Ringwald             break;
1737c485f8bSMatthias Ringwald 
1747c485f8bSMatthias Ringwald         case HCI_EVENT_LE_META:
1757c485f8bSMatthias Ringwald             // wait for connection complete
1767c485f8bSMatthias Ringwald             if (hci_event_le_meta_get_subevent_code(packet) != HCI_SUBEVENT_LE_CONNECTION_COMPLETE) break;
1777c485f8bSMatthias Ringwald             con_handle = hci_subevent_le_connection_complete_get_connection_handle(packet);
1787c485f8bSMatthias Ringwald             // start pairing
1797c485f8bSMatthias Ringwald             sm_request_pairing(con_handle);
1807c485f8bSMatthias Ringwald             break;
1817c485f8bSMatthias Ringwald         default:
1827c485f8bSMatthias Ringwald             break;
1837c485f8bSMatthias Ringwald     }
1847c485f8bSMatthias Ringwald }
1857c485f8bSMatthias Ringwald /* LISTING_END */
1867c485f8bSMatthias Ringwald 
1877c485f8bSMatthias Ringwald int btstack_main(void);
1887c485f8bSMatthias Ringwald int btstack_main(void)
1897c485f8bSMatthias Ringwald {
1907c485f8bSMatthias Ringwald     sm_pairing_central_setup();
1917c485f8bSMatthias Ringwald 
1927c485f8bSMatthias Ringwald     // turn on!
1937c485f8bSMatthias Ringwald     hci_power_control(HCI_POWER_ON);
1947c485f8bSMatthias Ringwald 
1957c485f8bSMatthias Ringwald     return 0;
1967c485f8bSMatthias Ringwald }
1977c485f8bSMatthias Ringwald 
1987c485f8bSMatthias Ringwald /* EXAMPLE_END */
199