341 lines
11 KiB
C
341 lines
11 KiB
C
/*
|
|
* Copyright (c) 2015, Texas Instruments Incorporated - http://www.ti.com/
|
|
* Copyright (c) 2017, University of Bristol - http://www.bristol.ac.uk/
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the copyright holder nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
* COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
|
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
|
|
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
|
|
* OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
/*---------------------------------------------------------------------------*/
|
|
/**
|
|
* \addtogroup rf-core-ble
|
|
* @{
|
|
*
|
|
* \file
|
|
* Implementation of the CC13xx/CC26xx RF BLE driver
|
|
*/
|
|
/*---------------------------------------------------------------------------*/
|
|
#include "contiki.h"
|
|
#include "sys/process.h"
|
|
#include "sys/clock.h"
|
|
#include "sys/cc.h"
|
|
#include "sys/etimer.h"
|
|
#include "net/netstack.h"
|
|
#include "net/linkaddr.h"
|
|
|
|
#include "rf-ble-beacond.h"
|
|
/*---------------------------------------------------------------------------*/
|
|
#include <ti/devices/DeviceFamily.h>
|
|
#include DeviceFamily_constructPath(driverlib/chipinfo.h)
|
|
#include DeviceFamily_constructPath(driverlib/rf_ble_cmd.h)
|
|
#include DeviceFamily_constructPath(driverlib/rf_common_cmd.h)
|
|
|
|
#include <ti/drivers/rf/RF.h>
|
|
/*---------------------------------------------------------------------------*/
|
|
#include "netstack-settings.h"
|
|
#include "rf-core.h"
|
|
#include "ble-addr.h"
|
|
/*---------------------------------------------------------------------------*/
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
/*---------------------------------------------------------------------------*/
|
|
#define DEBUG 0
|
|
#if DEBUG
|
|
#define PRINTF(...) printf(__VA_ARGS__)
|
|
#else
|
|
#define PRINTF(...)
|
|
#endif
|
|
/*---------------------------------------------------------------------------*/
|
|
#if !(RF_BLE_BEACOND_ENABLED)
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_init(void) { return RF_BLE_BEACOND_DISABLED; }
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_start(clock_time_t interval, const char *name) { return RF_BLE_BEACOND_DISABLED; }
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_stop(void) { return RF_BLE_BEACOND_DISABLED; }
|
|
/*---------------------------------------------------------------------------*/
|
|
int8_t
|
|
rf_ble_is_active(void) { return -1; }
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_set_tx_power(int8_t power) { return RF_BLE_BEACOND_DISABLED; }
|
|
/*---------------------------------------------------------------------------*/
|
|
int8_t
|
|
rf_ble_get_tx_power(void) { return ~(int8_t)(0); }
|
|
/*---------------------------------------------------------------------------*/
|
|
#else /* RF_BLE_BEACOND_ENABLED */
|
|
/*---------------------------------------------------------------------------*/
|
|
/* BLE Advertisement channels. Not to be changed by the user. */
|
|
typedef enum {
|
|
BLE_ADV_CHANNEL_37 = (1 << 0),
|
|
BLE_ADV_CHANNEL_38 = (1 << 1),
|
|
BLE_ADV_CHANNEL_39 = (1 << 2),
|
|
|
|
BLE_ADV_CHANNEL_MASK = BLE_ADV_CHANNEL_37
|
|
| BLE_ADV_CHANNEL_38
|
|
| BLE_ADV_CHANNEL_39,
|
|
} ble_adv_channel_t;
|
|
|
|
#define BLE_ADV_CHANNEL_MIN 37
|
|
#define BLE_ADV_CHANNEL_MAX 39
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Maximum BLE advertisement size. Not to be changed by the user. */
|
|
#define BLE_ADV_MAX_SIZE 31
|
|
/*---------------------------------------------------------------------------*/
|
|
/* BLE Intervals: Send a burst of advertisements every BLE_ADV_INTERVAL secs */
|
|
#define BLE_ADV_INTERVAL (CLOCK_SECOND * 5)
|
|
#define BLE_ADV_DUTY_CYCLE (CLOCK_SECOND / 10)
|
|
#define BLE_ADV_MESSAGES 10
|
|
|
|
/* BLE Advertisement-related macros */
|
|
#define BLE_ADV_TYPE_DEVINFO 0x01
|
|
#define BLE_ADV_TYPE_NAME 0x09
|
|
#define BLE_ADV_TYPE_MANUFACTURER 0xFF
|
|
#define BLE_ADV_NAME_BUF_LEN BLE_ADV_MAX_SIZE
|
|
#define BLE_ADV_PAYLOAD_BUF_LEN 64
|
|
#define BLE_UUID_SIZE 16
|
|
/*---------------------------------------------------------------------------*/
|
|
typedef struct {
|
|
/* Outgoing frame buffer */
|
|
uint8_t tx_buf[BLE_ADV_PAYLOAD_BUF_LEN] CC_ALIGN(4);
|
|
|
|
/* Config data */
|
|
size_t adv_name_len;
|
|
char adv_name[BLE_ADV_NAME_BUF_LEN];
|
|
|
|
/* Indicates whether deamon is active or not */
|
|
bool is_active;
|
|
|
|
/* Periodic timer for sending out BLE advertisements */
|
|
clock_time_t ble_adv_interval;
|
|
struct etimer ble_adv_et;
|
|
|
|
/* RF driver */
|
|
RF_Handle rf_handle;
|
|
} ble_beacond_t;
|
|
|
|
static ble_beacond_t ble_beacond;
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Configuration for TX power table */
|
|
#ifdef BLE_MODE_CONF_TX_POWER_TABLE
|
|
# define TX_POWER_TABLE BLE_MODE_CONF_TX_POWER_TABLE
|
|
#else
|
|
# define TX_POWER_TABLE rf_ble_tx_power_table
|
|
#endif
|
|
|
|
#ifdef BLE_MODE_CONF_TX_POWER_TABLE_SIZE
|
|
# define TX_POWER_TABLE_SIZE BLE_MODE_CONF_TX_POWER_TABLE_SIZE
|
|
#else
|
|
# define TX_POWER_TABLE_SIZE RF_BLE_TX_POWER_TABLE_SIZE
|
|
#endif
|
|
|
|
/* TX power table convenience macros */
|
|
#define TX_POWER_MIN (TX_POWER_TABLE[0].power)
|
|
#define TX_POWER_MAX (TX_POWER_TABLE[TX_POWER_TABLE_SIZE - 1].power)
|
|
|
|
#define TX_POWER_IN_RANGE(dbm) (((dbm) >= TX_POWER_MIN) && ((dbm) <= TX_POWER_MAX))
|
|
/*---------------------------------------------------------------------------*/
|
|
PROCESS(ble_beacond_process, "RF BLE Beacon Daemon Process");
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_init(void)
|
|
{
|
|
ble_adv_par.pDeviceAddress = (uint16_t *)ble_addr_ptr();
|
|
|
|
RF_Params rf_params;
|
|
RF_Params_init(&rf_params);
|
|
|
|
/* Should immediately turn off radio if possible */
|
|
rf_params.nInactivityTimeout = 0;
|
|
|
|
ble_beacond.handle = ble_open(&rf_params);
|
|
|
|
if (ble_beacond.handle == NULL) {
|
|
return RF_BLE_BEACOND_ERROR;
|
|
}
|
|
|
|
return RF_BLE_BEACOND_OK;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_start(clock_time_t interval, const char *name)
|
|
{
|
|
if (interval == 0) {
|
|
return RF_BLE_BEACOND_ERROR;
|
|
}
|
|
|
|
if (name == NULL) {
|
|
return RF_BLE_BEACOND_ERROR;
|
|
}
|
|
|
|
ble_beacond.ble_adv_interval = interval;
|
|
|
|
const size_t name_len = strlen(name);
|
|
|
|
if ((name_len == 0) ||
|
|
(name_len >= BLE_ADV_NAME_BUF_LEN)) {
|
|
return RF_BLE_BEACOND_ERROR;
|
|
}
|
|
|
|
ble_beacond.adv_name_len = name_len;
|
|
memcpy(ble_beacond.adv_name, name, name_len);
|
|
|
|
ble_beacond.is_active = true;
|
|
|
|
process_start(&ble_beacond_process, NULL);
|
|
|
|
return RF_BLE_BEACOND_OK;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_beacond_stop(void)
|
|
{
|
|
ble_beacond.is_active = false;
|
|
|
|
process_exit(&ble_beacond_process);
|
|
|
|
return RF_BLE_BEACOND_OK;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
int8_t
|
|
rf_ble_is_active(void)
|
|
{
|
|
return (int8_t)ble_beacond.is_active;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
rf_ble_beacond_result_t
|
|
rf_ble_set_tx_power(int8_t dBm)
|
|
{
|
|
rf_result_t res;
|
|
|
|
if (!TX_POWER_IN_RANGE(dBm)) {
|
|
return RADIO_RESULT_INVALID_VALUE;
|
|
}
|
|
|
|
res = rf_set_tx_power(ble_beacond.rf_handle, TX_POWER_TABLE, dbm);
|
|
|
|
return (res == RF_RESULT_OK)
|
|
? RF_BLE_BEACOND_OK
|
|
: RF_BLE_BEACOND_ERROR;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
int8_t
|
|
rf_ble_get_tx_power(void)
|
|
{
|
|
rf_result_t res;
|
|
|
|
int8_t dbm;
|
|
res = rf_get_tx_power(ble_beacond.rf_handle, TX_POWER_TABLE, &dbm)
|
|
|
|
if (res != RF_RESULT_OK) {
|
|
return ~(int8_t)0;
|
|
}
|
|
|
|
return dbm;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
static rf_ble_beacond_result_t
|
|
ble_beacon_burst(uint8_t channels_bm, uint8_t *data, uint8_t len)
|
|
{
|
|
rf_result_t res;
|
|
|
|
uint8_t channel;
|
|
for (channel = BLE_ADV_CHANNEL_MIN; channel <= BLE_ADV_CHANNEL_MAX; ++channel) {
|
|
const uint8_t channel_bv = (1 << (channel - BLE_ADV_CHANNEL_MIN));
|
|
if ((channel_bv & channels_bm) == 0) {
|
|
continue;
|
|
}
|
|
|
|
ble_adv_par.advLen = len;
|
|
ble_adv_par.pAdvData = data;
|
|
|
|
ble_cmd_beacon.channel = channel;
|
|
|
|
res = ble_sched_beacon(NULL, 0);
|
|
|
|
if (res != RF_RESULT_OK) {
|
|
return RF_BLE_BEACOND_ERROR;
|
|
}
|
|
}
|
|
|
|
return RF_BLE_BEACOND_OK;
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
PROCESS_THREAD(ble_beacond_process, ev, data)
|
|
{
|
|
static size_t i;
|
|
static size_t len;
|
|
|
|
PROCESS_BEGIN();
|
|
|
|
while(1) {
|
|
etimer_set(&beacond_config.ble_adv_et, beacond_config.ble_adv_interval);
|
|
PROCESS_WAIT_EVENT_UNTIL(etimer_expired(&beacond_config.ble_adv_et) ||
|
|
(ev == PROCESS_EVENT_EXIT));
|
|
|
|
if(ev == PROCESS_EVENT_EXIT) {
|
|
PROCESS_EXIT();
|
|
}
|
|
|
|
/* Set the adv payload each pass: The device name may have changed */
|
|
len = 0;
|
|
|
|
/* Device info */
|
|
beacond_config.tx_buf[len++] = (uint8_t)0x02; /* 2 bytes */
|
|
beacond_config.tx_buf[len++] = (uint8_t)BLE_ADV_TYPE_DEVINFO;
|
|
beacond_config.tx_buf[len++] = (uint8_t)0x1A; /* LE general discoverable + BR/EDR */
|
|
beacond_config.tx_buf[len++] = (uint8_t)beacond_config.adv_name_len;
|
|
beacond_config.tx_buf[len++] = (uint8_t)BLE_ADV_TYPE_NAME;
|
|
|
|
memcpy(beacond_config.tx_buf + len, beacond_config.adv_name, beacond_config.adv_name_len);
|
|
len += beacond_config.adv_name_len;
|
|
|
|
/*
|
|
* Send BLE_ADV_MESSAGES beacon bursts. Each burst on all three
|
|
* channels, with a BLE_ADV_DUTY_CYCLE interval between bursts
|
|
*/
|
|
ble_beacon_burst(BLE_ADV_CHANNEL_ALL, beacond_config.tx_buf, len);
|
|
for(i = 1; i < BLE_ADV_MESSAGES; ++i) {
|
|
etimer_set(&beacond_config.ble_adv_et, BLE_ADV_DUTY_CYCLE);
|
|
PROCESS_WAIT_EVENT_UNTIL(etimer_expired(&ble_adv_et));
|
|
|
|
ble_beacon_burst(BLE_ADV_CHANNEL_ALL, beacond_config.tx_buf, len);
|
|
}
|
|
}
|
|
PROCESS_END();
|
|
}
|
|
/*---------------------------------------------------------------------------*/
|
|
#endif /* RF_BLE_BEACOND_ENABLED */
|
|
/*---------------------------------------------------------------------------*/
|
|
/**
|
|
* @}
|
|
* @}
|
|
*/
|