subsys/bluetooth/services/tps.c

/** @file
 *  @brief GATT TX Power Service
 */

/*
 * Copyright (c) 2020 Nordic Semiconductor ASA
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#include <errno.h>
#include <zephyr/types.h>

#include <zephyr/bluetooth/bluetooth.h>
#include <zephyr/bluetooth/conn.h>
#include <zephyr/bluetooth/gatt.h>
#include <zephyr/bluetooth/uuid.h>
#include <zephyr/bluetooth/hci.h>

#define LOG_LEVEL CONFIG_BT_TPS_LOG_LEVEL
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(tps);

static ssize_t read_tx_power_level(struct bt_conn *conn,
				   const struct bt_gatt_attr *attr, void *buf,
				   uint16_t len, uint16_t offset)
{
	int err;
	struct bt_conn_le_tx_power tx_power_level = {0};

	if (offset) {
		return BT_GATT_ERR(BT_ATT_ERR_INVALID_OFFSET);
	}

	err = bt_conn_le_get_tx_power_level(conn, &tx_power_level);
	if (err) {
		LOG_ERR("Failed to read Tx Power Level over HCI: %d", err);
		return BT_GATT_ERR(BT_ATT_ERR_UNLIKELY);
	}

	LOG_INF("TPS Tx Power Level read %d", tx_power_level.current_level);

	return bt_gatt_attr_read(conn, attr, buf, len, offset,
				 &tx_power_level.current_level,
				 sizeof(tx_power_level.current_level));
}

BT_GATT_SERVICE_DEFINE(tps_svc,
	BT_GATT_PRIMARY_SERVICE(BT_UUID_TPS),
	BT_GATT_CHARACTERISTIC(BT_UUID_TPS_TX_POWER_LEVEL,
			       BT_GATT_CHRC_READ, BT_GATT_PERM_READ,
			       read_tx_power_level, NULL, NULL),
);