1 /* main.c - Application main entry point */
2 
3 /*
4  * Copyright (c) 2015-2016 Intel Corporation
5  *
6  * SPDX-License-Identifier: Apache-2.0
7  */
8 
9 #include <zephyr/types.h>
10 #include <stddef.h>
11 #include <string.h>
12 #include <errno.h>
13 #include <zephyr/sys/printk.h>
14 #include <zephyr/sys/byteorder.h>
15 #include <zephyr/kernel.h>
16 
17 #include <zephyr/bluetooth/bluetooth.h>
18 #include <zephyr/bluetooth/hci.h>
19 #include <zephyr/bluetooth/conn.h>
20 #include <zephyr/bluetooth/uuid.h>
21 #include <zephyr/bluetooth/gatt.h>
22 
23 static const struct bt_data ad[] = {
24 	BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR)),
25 };
26 
27 static const struct bt_data sd[] = {
28 	BT_DATA(BT_DATA_NAME_COMPLETE, CONFIG_BT_DEVICE_NAME, sizeof(CONFIG_BT_DEVICE_NAME) - 1),
29 };
30 
start_adv(void)31 static void start_adv(void)
32 {
33 	int err;
34 
35 	err = bt_le_adv_start(BT_LE_ADV_CONN_FAST_1, ad, ARRAY_SIZE(ad), sd, ARRAY_SIZE(sd));
36 	if (err) {
37 		printk("Advertising failed to start (err %d)\n", err);
38 	} else {
39 		printk("Advertising successfully started\n");
40 	}
41 }
42 
connected(struct bt_conn * conn,uint8_t err)43 static void connected(struct bt_conn *conn, uint8_t err)
44 {
45 	char addr[BT_ADDR_LE_STR_LEN];
46 
47 	bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr));
48 
49 	if (err) {
50 		printk("Failed to connect to %s %u %s\n", addr, err, bt_hci_err_to_str(err));
51 		return;
52 	}
53 
54 	printk("Connected %s\n", addr);
55 
56 	if (bt_conn_set_security(conn, BT_SECURITY_L4)) {
57 		printk("Failed to set security\n");
58 	}
59 }
60 
disconnected(struct bt_conn * conn,uint8_t reason)61 static void disconnected(struct bt_conn *conn, uint8_t reason)
62 {
63 	char addr[BT_ADDR_LE_STR_LEN];
64 
65 	bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr));
66 
67 	printk("Disconnected from %s, reason 0x%02x %s\n", addr,
68 	       reason, bt_hci_err_to_str(reason));
69 }
70 
identity_resolved(struct bt_conn * conn,const bt_addr_le_t * rpa,const bt_addr_le_t * identity)71 static void identity_resolved(struct bt_conn *conn, const bt_addr_le_t *rpa,
72 			      const bt_addr_le_t *identity)
73 {
74 	char addr_identity[BT_ADDR_LE_STR_LEN];
75 	char addr_rpa[BT_ADDR_LE_STR_LEN];
76 
77 	bt_addr_le_to_str(identity, addr_identity, sizeof(addr_identity));
78 	bt_addr_le_to_str(rpa, addr_rpa, sizeof(addr_rpa));
79 
80 	printk("Identity resolved %s -> %s\n", addr_rpa, addr_identity);
81 }
82 
security_changed(struct bt_conn * conn,bt_security_t level,enum bt_security_err err)83 static void security_changed(struct bt_conn *conn, bt_security_t level,
84 			     enum bt_security_err err)
85 {
86 	char addr[BT_ADDR_LE_STR_LEN];
87 
88 	bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr));
89 
90 	if (!err) {
91 		printk("Security changed: %s level %u\n", addr, level);
92 	} else {
93 		printk("Security failed: %s level %u err %s(%d)\n", addr, level,
94 		       bt_security_err_to_str(err), err);
95 	}
96 }
97 
98 BT_CONN_CB_DEFINE(conn_callbacks) = {
99 	.connected = connected,
100 	.disconnected = disconnected,
101 	.recycled = start_adv,
102 	.identity_resolved = identity_resolved,
103 	.security_changed = security_changed,
104 };
105 
auth_passkey_display(struct bt_conn * conn,unsigned int passkey)106 static void auth_passkey_display(struct bt_conn *conn, unsigned int passkey)
107 {
108 	char addr[BT_ADDR_LE_STR_LEN];
109 
110 	bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr));
111 
112 	printk("Passkey for %s: %06u\n", addr, passkey);
113 }
114 
auth_cancel(struct bt_conn * conn)115 static void auth_cancel(struct bt_conn *conn)
116 {
117 	char addr[BT_ADDR_LE_STR_LEN];
118 
119 	bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr));
120 
121 	printk("Pairing cancelled: %s\n", addr);
122 }
123 
pairing_complete(struct bt_conn * conn,bool bonded)124 static void pairing_complete(struct bt_conn *conn, bool bonded)
125 {
126 	printk("Pairing Complete\n");
127 }
128 
pairing_failed(struct bt_conn * conn,enum bt_security_err reason)129 static void pairing_failed(struct bt_conn *conn, enum bt_security_err reason)
130 {
131 	printk("Pairing Failed (%d). Disconnecting.\n", reason);
132 	bt_conn_disconnect(conn, BT_HCI_ERR_AUTH_FAIL);
133 }
134 
135 static struct bt_conn_auth_cb auth_cb_display = {
136 	.passkey_display = auth_passkey_display,
137 	.passkey_entry = NULL,
138 	.cancel = auth_cancel,
139 };
140 
141 static struct bt_conn_auth_info_cb auth_cb_info = {
142 	.pairing_complete = pairing_complete,
143 	.pairing_failed = pairing_failed,
144 };
145 
main(void)146 int main(void)
147 {
148 	int err;
149 
150 	err = bt_enable(NULL);
151 	if (err) {
152 		printk("Bluetooth init failed (err %d)\n", err);
153 		return 0;
154 	}
155 
156 	printk("Bluetooth initialized\n");
157 
158 	bt_conn_auth_cb_register(&auth_cb_display);
159 	bt_conn_auth_info_cb_register(&auth_cb_info);
160 
161 	start_adv();
162 
163 	return 0;
164 }
165