sv/IronOS
1
0
Fork 0
forked from me/IronOS
Code Pull Requests Activity

Formatting improvements

Browse Source
This commit is contained in:
Ben V. Brown
2022-11-20 17:15:37 +11:00
parent a160f7e7ad
commit 3f34d240fe
1 changed files with 118 additions and 141 deletions
Download Patch File Download Diff File Expand all files Collapse all files

91
source/Core/BSP/Pinecilv2/ble_peripheral.c
View File

@@ -9,26 +9,31 @@ NOTES
*/ */
/****************************************************************************/ /****************************************************************************/
#include <FreeRTOS.h>
#include <errno.h> #include <errno.h>
#include <stdbool.h> #include <stdbool.h>
#include <stdlib.h> #include <stdlib.h>
#include <FreeRTOS.h>
#include <task.h> #include <task.h>
#include "ble_characteristics.h"
#include "types.h"
#include "ble_peripheral.h"
#include "bluetooth.h" #include "bluetooth.h"
#include "conn.h" #include "conn.h"
#include "gatt.h" #include "gatt.h"
#include "hci_core.h"
#include "uuid.h"
#include "ble_peripheral.h"
#include "log.h"
#include "hal_clock.h" #include "hal_clock.h"
#include "hci_core.h"
#include "log.h"
#include "uuid.h"
#include "ble_characteristics.h"
bool pds_start; bool pds_start;
static void ble_device_connected(struct bt_conn *conn, u8_t err); static void ble_device_connected(struct bt_conn *conn, u8_t err);
static void ble_device_disconnected(struct bt_conn *conn, u8_t reason); static void ble_device_disconnected(struct bt_conn *conn, u8_t reason);
static void ble_connection_param_changed(struct bt_conn *conn, u16_t interval, u16_t latency, u16_t timeout); static void ble_connection_param_changed(struct bt_conn *conn, u16_t interval, u16_t latency, u16_t timeout);
struct bt_gatt_attr *get_attr(u8_t index);
static struct bt_conn *ble_tp_conn; static struct bt_conn *ble_tp_conn;
static struct bt_gatt_exchange_params exchg_mtu; static struct bt_gatt_exchange_params exchg_mtu;
@@ -46,9 +51,7 @@ static struct bt_conn_cb ble_tp_conn_callbacks = {
NAME NAME
ble_tx_mtu_change_callback ble_tx_mtu_change_callback
*/ */
static void ble_tx_mtu_change_callback(struct bt_conn *conn, u8_t err, static void ble_tx_mtu_change_callback(struct bt_conn *conn, u8_t err, struct bt_gatt_exchange_params *params) {
struct bt_gatt_exchange_params *params)
{
if (!err) { if (!err) {
tx_mtu_size = bt_gatt_get_mtu(ble_tp_conn); tx_mtu_size = bt_gatt_get_mtu(ble_tp_conn);
BT_WARN("ble tp echange mtu size success, mtu size: %d", tx_mtu_size); BT_WARN("ble tp echange mtu size success, mtu size: %d", tx_mtu_size);
@@ -60,8 +63,7 @@ static void ble_tx_mtu_change_callback(struct bt_conn *conn, u8_t err,
NAME NAME
ble_device_connected ble_device_connected
*/ */
static void ble_device_connected(struct bt_conn *conn, u8_t err) static void ble_device_connected(struct bt_conn *conn, u8_t err) {
{
int tx_octets = 0x00fb; int tx_octets = 0x00fb;
int tx_time = 0x0848; int tx_time = 0x0848;
int ret = -1; int ret = -1;
@@ -74,7 +76,7 @@ static void ble_device_connected(struct bt_conn *conn, u8_t err)
ble_tp_conn = conn; ble_tp_conn = conn;
pds_start = false; pds_start = false;
//set data length after connected. // set data length after connected.
ret = bt_le_set_data_len(ble_tp_conn, tx_octets, tx_time); ret = bt_le_set_data_len(ble_tp_conn, tx_octets, tx_time);
if (!ret) { if (!ret) {
@@ -83,7 +85,7 @@ static void ble_device_connected(struct bt_conn *conn, u8_t err)
BT_WARN("ble tp set data length failure, err: %d", ret); BT_WARN("ble tp set data length failure, err: %d", ret);
} }
//exchange mtu size after connected. // exchange mtu size after connected.
exchg_mtu.func = ble_tx_mtu_change_callback; exchg_mtu.func = ble_tx_mtu_change_callback;
ret = bt_gatt_exchange_mtu(ble_tp_conn, &exchg_mtu); ret = bt_gatt_exchange_mtu(ble_tp_conn, &exchg_mtu);
@@ -98,8 +100,7 @@ static void ble_device_connected(struct bt_conn *conn, u8_t err)
NAME NAME
ble_device_disconnected ble_device_disconnected
*/ */
static void ble_device_disconnected(struct bt_conn *conn, u8_t reason) static void ble_device_disconnected(struct bt_conn *conn, u8_t reason) {
{
BT_WARN("Tp disconnected"); BT_WARN("Tp disconnected");
if (created_tp_task) { if (created_tp_task) {
@@ -119,9 +120,7 @@ NAME
ble_connection_param_changed ble_connection_param_changed
*/ */
static void ble_connection_param_changed(struct bt_conn *conn, u16_t interval, static void ble_connection_param_changed(struct bt_conn *conn, u16_t interval, u16_t latency, u16_t timeout) {
u16_t latency, u16_t timeout)
{
BT_INFO("LE conn param updated: int 0x%04x lat %d to %d \r\n", interval, latency, timeout); BT_INFO("LE conn param updated: int 0x%04x lat %d to %d \r\n", interval, latency, timeout);
} }
@@ -129,11 +128,9 @@ static void ble_connection_param_changed(struct bt_conn *conn, u16_t interval,
NAME NAME
ble_tp_recv_rd ble_tp_recv_rd
*/ */
static int ble_tp_recv_rd(struct bt_conn *conn, const struct bt_gatt_attr *attr, static int ble_tp_recv_rd(struct bt_conn *conn, const struct bt_gatt_attr *attr, void *buf, u16_t len, u16_t offset) {
void *buf, u16_t len, u16_t offset)
{
int size = 9; int size = 9;
char data[9] = { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09 }; char data[9] = {0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09};
memcpy(buf, data, size); memcpy(buf, data, size);
@@ -144,38 +141,34 @@ static int ble_tp_recv_rd(struct bt_conn *conn, const struct bt_gatt_attr *attr,
NAME NAME
ble_tp_recv_wr(receive data from client) ble_tp_recv_wr(receive data from client)
*/ */
static int ble_tp_recv_wr(struct bt_conn *conn, const struct bt_gatt_attr *attr, static int ble_tp_recv_wr(struct bt_conn *conn, const struct bt_gatt_attr *attr, const void *buf, u16_t len, u16_t offset, u8_t flags) {
const void *buf, u16_t len, u16_t offset, u8_t flags)
{
BT_WARN("recv data len=%d, offset=%d, flag=%d", len, offset, flags); BT_WARN("recv data len=%d, offset=%d, flag=%d", len, offset, flags);
BT_WARN("recv data:%s", bt_hex(buf, len)); BT_WARN("recv data:%s", bt_hex(buf, len));
if (flags & BT_GATT_WRITE_FLAG_PREPARE) { if (flags & BT_GATT_WRITE_FLAG_PREPARE) {
//Don't use prepare write data, execute write will upload data again. // Don't use prepare write data, execute write will upload data again.
BT_WARN("recv prepare write request"); BT_WARN("recv prepare write request");
return 0; return 0;
} }
if (flags & BT_GATT_WRITE_FLAG_CMD) { if (flags & BT_GATT_WRITE_FLAG_CMD) {
//Use write command data. // Use write command data.
BT_WARN("recv write command"); BT_WARN("recv write command");
} else { } else {
//Use write request / execute write data. // Use write request / execute write data.
BT_WARN("recv write request / exce write"); BT_WARN("recv write request / exce write");
} }
return len; return len;
} }
/************************************************************************* /*************************************************************************
NAME NAME
ble_tp_ind_ccc_changed ble_tp_ind_ccc_changed
*/ */
static void ble_tp_ind_ccc_changed(const struct bt_gatt_attr *attr, u16_t value) static void ble_tp_ind_ccc_changed(const struct bt_gatt_attr *attr, u16_t value) {
{
int err = -1; int err = -1;
char data[9] = { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09 }; char data[9] = {0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09};
if (value == BT_GATT_CCC_INDICATE) { if (value == BT_GATT_CCC_INDICATE) {
err = bl_tp_send_indicate(ble_tp_conn, get_attr(BT_CHAR_BLE_TP_IND_ATTR_VAL_INDEX), data, 9); err = bl_tp_send_indicate(ble_tp_conn, get_attr(BT_CHAR_BLE_TP_IND_ATTR_VAL_INDEX), data, 9);
@@ -183,22 +176,13 @@ static void ble_tp_ind_ccc_changed(const struct bt_gatt_attr *attr, u16_t value)
} }
} }
/************************************************************************* /*************************************************************************
* DEFINE : attrs * DEFINE : attrs
*/ */
static struct bt_gatt_attr attrs[] = { static struct bt_gatt_attr attrs[] = {
BT_GATT_PRIMARY_SERVICE(BT_UUID_SVC_LIVE_DATA), BT_GATT_PRIMARY_SERVICE(BT_UUID_SVC_LIVE_DATA),
BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_LIVE_SETPOINT_TEMP, BT_GATT_CHARACTERISTIC(BT_UUID_CHAR_BLE_LIVE_SETPOINT_TEMP, BT_GATT_CHRC_READ, BT_GATT_PERM_READ, ble_tp_recv_rd, NULL, NULL),
BT_GATT_CHRC_READ,
BT_GATT_PERM_READ,
ble_tp_recv_rd,
NULL,
NULL),
}; };
@@ -206,23 +190,19 @@ static struct bt_gatt_attr attrs[] = {
NAME NAME
get_attr get_attr
*/ */
struct bt_gatt_attr *get_attr(u8_t index) struct bt_gatt_attr *get_attr(u8_t index) {
{
return &attrs[index]; return &attrs[index];
} }
static struct bt_gatt_service ble_tp_server = BT_GATT_SERVICE(attrs); static struct bt_gatt_service ble_tp_server = BT_GATT_SERVICE(attrs);
const char *DEVICE_BLE_NAME = "Pinecil";
// Start advertising with expected default values
const char* DEVICE_BLE_NAME="Pinecil"; int ble_start_adv(void) {
//Start advertising with expected default values
int ble_start_adv(void)
{
MSG("BLE Starting advertising\n"); MSG("BLE Starting advertising\n");
struct bt_le_adv_param adv_param = { struct bt_le_adv_param adv_param = {
//options:3, connectable undirected, adv one time // options:3, connectable undirected, adv one time
.options = 3, .options = 3,
.interval_min = BT_GAP_ADV_FAST_INT_MIN_3, .interval_min = BT_GAP_ADV_FAST_INT_MIN_3,
.interval_max = BT_GAP_ADV_FAST_INT_MAX_3, .interval_max = BT_GAP_ADV_FAST_INT_MAX_3,
@@ -236,12 +216,9 @@ int ble_start_adv(void)
return bt_le_adv_start(&adv_param, adv_data, ARRAY_SIZE(adv_data), &adv_data[1], 1); return bt_le_adv_start(&adv_param, adv_data, ARRAY_SIZE(adv_data), &adv_data[1], 1);
} }
// Callback that the ble stack will call once it has been kicked off running // Callback that the ble stack will call once it has been kicked off running
// We use this to register the handlers (as we know its now ready for them) + start advertising to the world // We use this to register the handlers (as we know its now ready for them) + start advertising to the world
void bt_enable_cb(int err) void bt_enable_cb(int err) {
{
bt_conn_cb_register(&ble_tp_conn_callbacks); bt_conn_cb_register(&ble_tp_conn_callbacks);
bt_gatt_service_register(&ble_tp_server); bt_gatt_service_register(&ble_tp_server);