NimbleController : Implement device info service
This commit is contained in:
parent
a9254ee90e
commit
14d6954466
|
@ -9,14 +9,134 @@
|
|||
#include <host/ble_gap.h>
|
||||
#include <hal/nrf_rtc.h>
|
||||
|
||||
|
||||
using namespace Pinetime::Controllers;
|
||||
|
||||
// TODO c++ify the following code
|
||||
// - device info should be in its own class
|
||||
// - cts should be in it own class
|
||||
|
||||
#define BLE_GATT_SVC_DEVINFO (0x180a) /**< device info */
|
||||
#define BLE_GATT_CHAR_MANUFACTURER_NAME (0x2a29) /**< manufacturer name */
|
||||
#define BLE_GATT_CHAR_MODEL_NUMBER_STR (0x2a24) /**< model number */
|
||||
#define BLE_GATT_CHAR_SERIAL_NUMBER_STR (0x2a25) /**< serial number */
|
||||
#define BLE_GATT_CHAR_FW_REV_STR (0x2a26) /**< firmware revision */
|
||||
#define BLE_GATT_CHAR_HW_REV_STR (0x2a27) /**< hardware revision */
|
||||
|
||||
static int _devinfo_handler(uint16_t conn_handle, uint16_t attr_handle,
|
||||
struct ble_gatt_access_ctxt *ctxt, void *arg) {
|
||||
const char *str;
|
||||
|
||||
switch (ble_uuid_u16(ctxt->chr->uuid)) {
|
||||
case BLE_GATT_CHAR_MANUFACTURER_NAME:
|
||||
str = "Codingfield";
|
||||
break;
|
||||
case BLE_GATT_CHAR_MODEL_NUMBER_STR:
|
||||
str = "1";
|
||||
break;
|
||||
case BLE_GATT_CHAR_SERIAL_NUMBER_STR:
|
||||
str = "1.2.3.4.5.6";
|
||||
break;
|
||||
case BLE_GATT_CHAR_FW_REV_STR:
|
||||
str = "0.5.0";
|
||||
break;
|
||||
case BLE_GATT_CHAR_HW_REV_STR:
|
||||
str = "1.0";
|
||||
break;
|
||||
default:
|
||||
return BLE_ATT_ERR_UNLIKELY;
|
||||
}
|
||||
|
||||
int res = os_mbuf_append(ctxt->om, str, strlen(str));
|
||||
return (res == 0) ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
|
||||
}
|
||||
|
||||
ble_uuid16_t deviceInfoUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_SVC_DEVINFO
|
||||
};
|
||||
|
||||
ble_uuid16_t manufacturerNameUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_CHAR_MANUFACTURER_NAME
|
||||
};
|
||||
|
||||
ble_uuid16_t modelNumberUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_CHAR_MODEL_NUMBER_STR
|
||||
};
|
||||
|
||||
ble_uuid16_t serialNumberUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_CHAR_SERIAL_NUMBER_STR
|
||||
};
|
||||
|
||||
ble_uuid16_t fwRevisionUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_CHAR_FW_REV_STR
|
||||
};
|
||||
|
||||
ble_uuid16_t hwRevisionUuid {
|
||||
.u { .type = BLE_UUID_TYPE_16 },
|
||||
.value = BLE_GATT_CHAR_HW_REV_STR
|
||||
};
|
||||
|
||||
|
||||
static const struct ble_gatt_svc_def gatt_svr_svcs[] = {
|
||||
{
|
||||
/* Device Information Service */
|
||||
.type = BLE_GATT_SVC_TYPE_PRIMARY,
|
||||
.uuid = (ble_uuid_t*)&deviceInfoUuid,
|
||||
.characteristics = (struct ble_gatt_chr_def[]) {
|
||||
{
|
||||
.uuid = (ble_uuid_t*)&manufacturerNameUuid,
|
||||
.access_cb = _devinfo_handler,
|
||||
.arg = nullptr,
|
||||
.flags = BLE_GATT_CHR_F_READ,
|
||||
|
||||
},
|
||||
{
|
||||
.uuid = (ble_uuid_t*)&modelNumberUuid,
|
||||
.access_cb = _devinfo_handler,
|
||||
.arg = nullptr,
|
||||
.flags = BLE_GATT_CHR_F_READ,
|
||||
},
|
||||
{
|
||||
.uuid = (ble_uuid_t*)&serialNumberUuid,
|
||||
.access_cb = _devinfo_handler,
|
||||
.arg = nullptr,
|
||||
.flags = BLE_GATT_CHR_F_READ,
|
||||
},
|
||||
{
|
||||
.uuid = (ble_uuid_t*)&fwRevisionUuid,
|
||||
.access_cb = _devinfo_handler,
|
||||
.arg = nullptr,
|
||||
.flags = BLE_GATT_CHR_F_READ,
|
||||
},
|
||||
{
|
||||
.uuid = (ble_uuid_t*)&hwRevisionUuid,
|
||||
.access_cb = _devinfo_handler,
|
||||
.arg = nullptr,
|
||||
.flags = BLE_GATT_CHR_F_READ,
|
||||
},
|
||||
{
|
||||
0, /* no more characteristics in this service */
|
||||
},
|
||||
}
|
||||
},
|
||||
{
|
||||
0, /* no more services */
|
||||
},
|
||||
};
|
||||
|
||||
|
||||
NimbleController::NimbleController(DateTime& datetimeController) : dateTimeController{datetimeController} {
|
||||
ctsUuid.u.type = BLE_UUID_TYPE_16;
|
||||
ctsUuid.value = BleGatServiceCts;
|
||||
|
||||
ctsCurrentTimeUuid.u.type = BLE_UUID_TYPE_16;
|
||||
ctsCurrentTimeUuid.value = bleGattCharacteristicCurrentTime;
|
||||
|
||||
}
|
||||
|
||||
int GAPEventCallback(struct ble_gap_event *event, void *arg) {
|
||||
|
@ -48,10 +168,13 @@ void NimbleController::Init() {
|
|||
ble_svc_gap_init();
|
||||
ble_svc_gatt_init();
|
||||
|
||||
ble_gatts_count_cfg(gatt_svr_svcs);
|
||||
ble_gatts_add_svcs(gatt_svr_svcs);
|
||||
int res;
|
||||
res = ble_hs_util_ensure_addr(0);
|
||||
res = ble_hs_id_infer_auto(0, &addrType);
|
||||
res = ble_svc_gap_device_name_set(deviceName);
|
||||
ble_gatts_start();
|
||||
}
|
||||
|
||||
void NimbleController::StartAdvertising() {
|
||||
|
@ -90,9 +213,9 @@ void NimbleController::StartAdvertising() {
|
|||
res = ble_gap_adv_set_fields(&fields);
|
||||
assert(res == 0);
|
||||
|
||||
res = ble_gap_adv_rsp_set_fields(&rsp_fields);
|
||||
ble_gap_adv_rsp_set_fields(&rsp_fields);
|
||||
|
||||
res = ble_gap_adv_start(addrType, NULL, 10000,
|
||||
ble_gap_adv_start(addrType, NULL, 10000,
|
||||
&adv_params, GAPEventCallback, this);
|
||||
|
||||
|
||||
|
|
Loading…
Reference in a new issue