/*
|
* Licensed to the Apache Software Foundation (ASF) under one
|
* or more contributor license agreements. See the NOTICE file
|
* distributed with this work for additional information
|
* regarding copyright ownership. The ASF licenses this file
|
* to you under the Apache License, Version 2.0 (the
|
* "License"); you may not use this file except in compliance
|
* with the License. You may obtain a copy of the License at
|
*
|
* http://www.apache.org/licenses/LICENSE-2.0
|
*
|
* Unless required by applicable law or agreed to in writing,
|
* software distributed under the License is distributed on an
|
* "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
|
* KIND, either express or implied. See the License for the
|
* specific language governing permissions and limitations
|
* under the License.
|
*/
|
|
#include <assert.h>
|
#include <string.h>
|
|
#include "sysinit/sysinit.h"
|
#include "host/ble_hs.h"
|
#include "services/gap/ble_svc_gap.h"
|
#include "os/endian.h"
|
|
#pragma diag_suppress 550
|
|
#define PPCP_ENABLED \
|
MYNEWT_VAL(BLE_ROLE_PERIPHERAL) && \
|
(MYNEWT_VAL(BLE_SVC_GAP_PPCP_MIN_CONN_INTERVAL) || \
|
MYNEWT_VAL(BLE_SVC_GAP_PPCP_MAX_CONN_INTERVAL) || \
|
MYNEWT_VAL(BLE_SVC_GAP_PPCP_SLAVE_LATENCY) || \
|
MYNEWT_VAL(BLE_SVC_GAP_PPCP_SUPERVISION_TMO))
|
|
#define BLE_SVC_GAP_NAME_MAX_LEN \
|
MYNEWT_VAL(BLE_SVC_GAP_DEVICE_NAME_MAX_LENGTH)
|
|
static ble_svc_gap_chr_changed_fn *ble_svc_gap_chr_changed_cb_fn;
|
|
static char ble_svc_gap_name[BLE_SVC_GAP_NAME_MAX_LEN + 1] =
|
MYNEWT_VAL(BLE_SVC_GAP_DEVICE_NAME);
|
static uint16_t ble_svc_gap_appearance = MYNEWT_VAL(BLE_SVC_GAP_APPEARANCE);
|
|
#if NIMBLE_BLE_CONNECT
|
static int
|
ble_svc_gap_access(uint16_t conn_handle, uint16_t attr_handle,
|
struct ble_gatt_access_ctxt *ctxt, void *arg);
|
|
static const struct ble_gatt_svc_def ble_svc_gap_defs[] = {
|
{
|
/*** Service: GAP. */
|
.type = BLE_GATT_SVC_TYPE_PRIMARY,
|
.uuid = BLE_UUID16_DECLARE(BLE_SVC_GAP_UUID16),
|
.characteristics = (struct ble_gatt_chr_def[]) { {
|
/*** Characteristic: Device Name. */
|
.uuid = BLE_UUID16_DECLARE(BLE_SVC_GAP_CHR_UUID16_DEVICE_NAME),
|
.access_cb = ble_svc_gap_access,
|
.flags = BLE_GATT_CHR_F_READ |
|
#if MYNEWT_VAL(BLE_SVC_GAP_DEVICE_NAME_WRITE_PERM) >= 0
|
BLE_GATT_CHR_F_WRITE |
|
MYNEWT_VAL(BLE_SVC_GAP_DEVICE_NAME_WRITE_PERM) |
|
#endif
|
0,
|
}, {
|
/*** Characteristic: Appearance. */
|
.uuid = BLE_UUID16_DECLARE(BLE_SVC_GAP_CHR_UUID16_APPEARANCE),
|
.access_cb = ble_svc_gap_access,
|
.flags = BLE_GATT_CHR_F_READ |
|
#if MYNEWT_VAL(BLE_SVC_GAP_APPEARANCE_WRITE_PERM) >= 0
|
BLE_GATT_CHR_F_WRITE |
|
MYNEWT_VAL(BLE_SVC_GAP_APPEARANCE_WRITE_PERM) |
|
#endif
|
0,
|
}, {
|
#if PPCP_ENABLED
|
/*** Characteristic: Peripheral Preferred Connection Parameters. */
|
.uuid =
|
BLE_UUID16_DECLARE(BLE_SVC_GAP_CHR_UUID16_PERIPH_PREF_CONN_PARAMS),
|
.access_cb = ble_svc_gap_access,
|
.flags = BLE_GATT_CHR_F_READ,
|
}, {
|
#endif
|
#if MYNEWT_VAL(BLE_SVC_GAP_CENTRAL_ADDRESS_RESOLUTION) >= 0
|
/*** Characteristic: Central Address Resolution. */
|
.uuid = BLE_UUID16_DECLARE(BLE_SVC_GAP_CHR_UUID16_CENTRAL_ADDRESS_RESOLUTION),
|
.access_cb = ble_svc_gap_access,
|
.flags = BLE_GATT_CHR_F_READ,
|
}, {
|
#endif
|
0, /* No more characteristics in this service. */
|
} },
|
},
|
|
{
|
0, /* No more services. */
|
},
|
};
|
|
static int
|
ble_svc_gap_device_name_read_access(struct ble_gatt_access_ctxt *ctxt)
|
{
|
int rc;
|
|
rc = os_mbuf_append(ctxt->om, ble_svc_gap_name, strlen(ble_svc_gap_name));
|
|
return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
|
}
|
|
static int
|
ble_svc_gap_device_name_write_access(struct ble_gatt_access_ctxt *ctxt)
|
{
|
#if MYNEWT_VAL(BLE_SVC_GAP_DEVICE_NAME_WRITE_PERM) < 0
|
assert(0);
|
return 0;
|
#else
|
uint16_t om_len;
|
int rc;
|
|
om_len = OS_MBUF_PKTLEN(ctxt->om);
|
if (om_len > BLE_SVC_GAP_NAME_MAX_LEN) {
|
return BLE_ATT_ERR_INVALID_ATTR_VALUE_LEN;
|
}
|
|
rc = ble_hs_mbuf_to_flat(ctxt->om, ble_svc_gap_name, om_len, NULL);
|
if (rc != 0) {
|
return BLE_ATT_ERR_UNLIKELY;
|
}
|
|
ble_svc_gap_name[om_len] = '\0';
|
|
if (ble_svc_gap_chr_changed_cb_fn) {
|
ble_svc_gap_chr_changed_cb_fn(BLE_SVC_GAP_CHR_UUID16_DEVICE_NAME);
|
}
|
|
return rc;
|
#endif
|
}
|
|
static int
|
ble_svc_gap_appearance_read_access(struct ble_gatt_access_ctxt *ctxt)
|
{
|
uint16_t appearance = htole16(ble_svc_gap_appearance);
|
int rc;
|
|
rc = os_mbuf_append(ctxt->om, &appearance, sizeof(appearance));
|
|
return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
|
}
|
|
static int
|
ble_svc_gap_appearance_write_access(struct ble_gatt_access_ctxt *ctxt)
|
{
|
#if MYNEWT_VAL(BLE_SVC_GAP_APPEARANCE_WRITE_PERM) < 0
|
assert(0);
|
return 0;
|
#else
|
uint16_t om_len;
|
int rc;
|
|
om_len = OS_MBUF_PKTLEN(ctxt->om);
|
if (om_len != sizeof(ble_svc_gap_appearance)) {
|
return BLE_ATT_ERR_INVALID_ATTR_VALUE_LEN;
|
}
|
|
rc = ble_hs_mbuf_to_flat(ctxt->om, &ble_svc_gap_appearance, om_len, NULL);
|
if (rc != 0) {
|
return BLE_ATT_ERR_UNLIKELY;
|
}
|
|
ble_svc_gap_appearance = le16toh(ble_svc_gap_appearance);
|
|
if (ble_svc_gap_chr_changed_cb_fn) {
|
ble_svc_gap_chr_changed_cb_fn(BLE_SVC_GAP_CHR_UUID16_APPEARANCE);
|
}
|
|
return rc;
|
#endif
|
}
|
|
static int
|
ble_svc_gap_access(uint16_t conn_handle, uint16_t attr_handle,
|
struct ble_gatt_access_ctxt *ctxt, void *arg)
|
{
|
uint16_t uuid16;
|
#if MYNEWT_VAL(BLE_SVC_GAP_CENTRAL_ADDRESS_RESOLUTION) >= 0
|
uint8_t central_ar = MYNEWT_VAL(BLE_SVC_GAP_CENTRAL_ADDRESS_RESOLUTION);
|
#endif
|
#if PPCP_ENABLED
|
uint16_t ppcp[4] = {
|
htole16(MYNEWT_VAL(BLE_SVC_GAP_PPCP_MIN_CONN_INTERVAL)),
|
htole16(MYNEWT_VAL(BLE_SVC_GAP_PPCP_MAX_CONN_INTERVAL)),
|
htole16(MYNEWT_VAL(BLE_SVC_GAP_PPCP_SLAVE_LATENCY)),
|
htole16(MYNEWT_VAL(BLE_SVC_GAP_PPCP_SUPERVISION_TMO))
|
};
|
#endif
|
int rc;
|
|
uuid16 = ble_uuid_u16(ctxt->chr->uuid);
|
assert(uuid16 != 0);
|
|
switch (uuid16) {
|
case BLE_SVC_GAP_CHR_UUID16_DEVICE_NAME:
|
if (ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR) {
|
rc = ble_svc_gap_device_name_read_access(ctxt);
|
} else if (ctxt->op == BLE_GATT_ACCESS_OP_WRITE_CHR) {
|
rc = ble_svc_gap_device_name_write_access(ctxt);
|
} else {
|
assert(0);
|
rc = BLE_ATT_ERR_UNLIKELY;
|
}
|
return rc;
|
|
case BLE_SVC_GAP_CHR_UUID16_APPEARANCE:
|
if (ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR) {
|
rc = ble_svc_gap_appearance_read_access(ctxt);
|
} else if (ctxt->op == BLE_GATT_ACCESS_OP_WRITE_CHR) {
|
rc = ble_svc_gap_appearance_write_access(ctxt);
|
} else {
|
assert(0);
|
rc = BLE_ATT_ERR_UNLIKELY;
|
}
|
return rc;
|
|
#if PPCP_ENABLED
|
case BLE_SVC_GAP_CHR_UUID16_PERIPH_PREF_CONN_PARAMS:
|
assert(ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR);
|
rc = os_mbuf_append(ctxt->om, &ppcp, sizeof(ppcp));
|
return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
|
#endif
|
|
#if MYNEWT_VAL(BLE_SVC_GAP_CENTRAL_ADDRESS_RESOLUTION) >= 0
|
case BLE_SVC_GAP_CHR_UUID16_CENTRAL_ADDRESS_RESOLUTION:
|
assert(ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR);
|
rc = os_mbuf_append(ctxt->om, ¢ral_ar, sizeof(central_ar));
|
return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
|
#endif
|
|
default:
|
assert(0);
|
return BLE_ATT_ERR_UNLIKELY;
|
}
|
}
|
#endif
|
|
const char *
|
ble_svc_gap_device_name(void)
|
{
|
return ble_svc_gap_name;
|
}
|
|
int
|
ble_svc_gap_device_name_set(const char *name)
|
{
|
int len;
|
|
len = strlen(name);
|
if (len > BLE_SVC_GAP_NAME_MAX_LEN) {
|
return BLE_HS_EINVAL;
|
}
|
|
memcpy(ble_svc_gap_name, name, len);
|
ble_svc_gap_name[len] = '\0';
|
|
return 0;
|
}
|
|
uint16_t
|
ble_svc_gap_device_appearance(void)
|
{
|
return ble_svc_gap_appearance;
|
}
|
|
int
|
ble_svc_gap_device_appearance_set(uint16_t appearance)
|
{
|
ble_svc_gap_appearance = appearance;
|
|
return 0;
|
}
|
|
void
|
ble_svc_gap_set_chr_changed_cb(ble_svc_gap_chr_changed_fn *cb)
|
{
|
ble_svc_gap_chr_changed_cb_fn = cb;
|
}
|
|
void
|
ble_svc_gap_init(void)
|
{
|
#if NIMBLE_BLE_CONNECT
|
int rc;
|
#endif
|
|
/* Ensure this function only gets called by sysinit. */
|
SYSINIT_ASSERT_ACTIVE();
|
|
#if NIMBLE_BLE_CONNECT
|
rc = ble_gatts_count_cfg(ble_svc_gap_defs);
|
SYSINIT_PANIC_ASSERT(rc == 0);
|
|
rc = ble_gatts_add_svcs(ble_svc_gap_defs);
|
SYSINIT_PANIC_ASSERT(rc == 0);
|
#endif
|
}
|
