blob: e9b4b670578b64631017e7ed8ab2a9179b9ddfa7 [file] [log] [blame]
/*
* Copyright (c) 2022 Michal Morsisko
* Copyright (c) 2015-2016 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/types.h>
#include <stddef.h>
#include <zephyr/sys/printk.h>
#include <zephyr/sys/reboot.h>
#include <zephyr/settings/settings.h>
#include <zephyr/bluetooth/bluetooth.h>
#include <zephyr/bluetooth/conn.h>
#include <zephyr/bluetooth/uuid.h>
#include <zephyr/bluetooth/gatt.h>
/* Custom Service Variables */
#define BT_UUID_CUSTOM_SERVICE_VAL \
BT_UUID_128_ENCODE(0x12345678, 0x1234, 0x5678, 0x1234, 0x56789abcdef0)
static struct bt_uuid_128 primary_service_uuid = BT_UUID_INIT_128(
BT_UUID_CUSTOM_SERVICE_VAL);
static struct bt_uuid_128 read_characteristic_uuid = BT_UUID_INIT_128(
BT_UUID_128_ENCODE(0x12345678, 0x1234, 0x5678, 0x1234, 0x56789abcdef1));
static struct bt_uuid_128 write_characteristic_uuid = BT_UUID_INIT_128(
BT_UUID_128_ENCODE(0x12345678, 0x1234, 0x5678, 0x1234, 0x56789abcdef2));
static int signed_value;
static struct bt_le_adv_param adv_param;
static int bond_count;
static ssize_t read_signed(struct bt_conn *conn, const struct bt_gatt_attr *attr,
void *buf, uint16_t len, uint16_t offset)
{
int *value = &signed_value;
return bt_gatt_attr_read(conn, attr, buf, len, offset, value,
sizeof(signed_value));
}
static ssize_t write_signed(struct bt_conn *conn, const struct bt_gatt_attr *attr,
const void *buf, uint16_t len, uint16_t offset,
uint8_t flags)
{
int *value = &signed_value;
if (offset + len > sizeof(signed_value)) {
return BT_GATT_ERR(BT_ATT_ERR_INVALID_OFFSET);
}
memcpy(value + offset, buf, len);
return len;
}
/* Vendor Primary Service Declaration */
BT_GATT_SERVICE_DEFINE(primary_service,
BT_GATT_PRIMARY_SERVICE(&primary_service_uuid),
BT_GATT_CHARACTERISTIC(&read_characteristic_uuid.uuid,
BT_GATT_CHRC_READ,
BT_GATT_PERM_READ,
read_signed, NULL, NULL),
BT_GATT_CHARACTERISTIC(&write_characteristic_uuid.uuid,
BT_GATT_CHRC_WRITE,
BT_GATT_PERM_WRITE_ENCRYPT,
NULL, write_signed, NULL),
);
static const struct bt_data ad[] = {
BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR))
};
static const struct bt_data sd[] = {
BT_DATA_BYTES(BT_DATA_UUID128_ALL, BT_UUID_CUSTOM_SERVICE_VAL)
};
static void connected(struct bt_conn *conn, uint8_t err)
{
if (err) {
printk("Connection failed (err 0x%02x)\n", err);
} else {
printk("Connected\n");
}
}
static void disconnected(struct bt_conn *conn, uint8_t reason)
{
printk("Disconnected (reason 0x%02x)\n", reason);
}
BT_CONN_CB_DEFINE(conn_callbacks) = {
.connected = connected,
.disconnected = disconnected
};
static void add_bonded_addr_to_filter_list(const struct bt_bond_info *info, void *data)
{
char addr_str[BT_ADDR_LE_STR_LEN];
bt_le_filter_accept_list_add(&info->addr);
bt_addr_le_to_str(&info->addr, addr_str, sizeof(addr_str));
printk("Added %s to advertising accept filter list\n", addr_str);
bond_count++;
}
static void bt_ready(void)
{
int err;
printk("Bluetooth initialized\n");
if (IS_ENABLED(CONFIG_SETTINGS)) {
settings_load();
}
bond_count = 0;
bt_foreach_bond(BT_ID_DEFAULT, add_bonded_addr_to_filter_list, NULL);
adv_param = *BT_LE_ADV_CONN_NAME;
/* If we have got at least one bond, activate the filter */
if (bond_count) {
/* BT_LE_ADV_OPT_FILTER_CONN is required to activate accept filter list,
* BT_LE_ADV_OPT_FILTER_SCAN_REQ will prevent sending scan response data to
* devices, that are not on the accept filter list
*/
adv_param.options |= BT_LE_ADV_OPT_FILTER_CONN | BT_LE_ADV_OPT_FILTER_SCAN_REQ;
}
err = bt_le_adv_start(&adv_param, ad, ARRAY_SIZE(ad), sd, ARRAY_SIZE(sd));
if (err) {
printk("Advertising failed to start (err %d)\n", err);
} else {
printk("Advertising successfully started\n");
}
}
void pairing_complete(struct bt_conn *conn, bool bonded)
{
printk("Pairing completed. Rebooting in 5 seconds...\n");
k_sleep(K_SECONDS(5));
sys_reboot(SYS_REBOOT_WARM);
}
static struct bt_conn_auth_info_cb bt_conn_auth_info = {
.pairing_complete = pairing_complete
};
int main(void)
{
int err;
err = bt_enable(NULL);
if (err) {
printk("Bluetooth init failed (err %d)\n", err);
return 0;
}
bt_ready();
bt_conn_auth_info_cb_register(&bt_conn_auth_info);
while (1) {
k_sleep(K_FOREVER);
}
return 0;
}