/**
 *******************************************************************************
 * @file     hrs.c
 * @create   2023-08-01
 * @author   Panchip BLE GROUP
 * @note
 * Copyright (c) 2022 Shanghai Panchip Microelectronics Co.,Ltd.
 *
 *******************************************************************************
 */
#pragma diag_suppress 111
 
#include "hrs.h"
#include "host/ble_hs.h"
#include "app_log.h"

/*******************************************************************************
 * Macro
 ******************************************************************************/

/*******************************************************************************
 * Variable Define & Declaration
 ******************************************************************************/
uint16_t hrs_hrm_handle;

/*******************************************************************************
 * Function Declaration
 ******************************************************************************/
static int ble_svc_hrs_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_hrs_def[] =
{
	{
        /* Service: Heart-rate */
        .type = BLE_GATT_SVC_TYPE_PRIMARY,
        .uuid = BLE_UUID16_DECLARE(BLE_SVC_HRS_UUID16),
        .characteristics = (struct ble_gatt_chr_def[])
		{
			{
				/* Characteristic: Heart-rate measurement */
				.uuid = BLE_UUID16_DECLARE(BLE_SVC_HRS_CHR_UUID16_MEASUREMENT),
				.access_cb = ble_svc_hrs_access,
				.val_handle = &hrs_hrm_handle,
				.flags = BLE_GATT_CHR_F_NOTIFY,
			},
			{
				/* Characteristic: Body sensor location */
				.uuid = BLE_UUID16_DECLARE(BLE_SVC_HRS_CHR_UUID16_BODY_SENSOR_LOC),
				.access_cb = ble_svc_hrs_access,
				.flags = BLE_GATT_CHR_F_READ,
			},
			{
				0, /* No more characteristics in this service */
			},
		}
    },
	{
		0, /* No more services */
	},
};

/*******************************************************************************
 * Function Define
 ******************************************************************************/
static int ble_svc_hrs_access(uint16_t conn_handle, uint16_t attr_handle,
                               struct ble_gatt_access_ctxt *ctxt, void *arg)
{
    /* Sensor location, set to "Chest" */
    static uint8_t body_sens_loc = 0x01;
    uint16_t uuid16 = ble_uuid_u16(ctxt->chr->uuid);
    int rc;
	
    switch(uuid16)
    {
    case BLE_SVC_HRS_CHR_UUID16_BODY_SENSOR_LOC:
    	app_assert(ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR);

		rc = os_mbuf_append(ctxt->om, &body_sens_loc, sizeof(body_sens_loc));
		return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;

    default:
    	app_assert(0);
    	//break;
    }

    //return BLE_ATT_ERR_UNLIKELY;
}

int ble_svc_hrs_notify(uint16_t conn_handle, uint8_t *pdata, uint32_t len)
{
	int rc = 0;
	struct os_mbuf *om = ble_hs_mbuf_from_flat(pdata, len);
	if(om== NULL){
		return BLE_NPL_ENOMEM;
	}

	rc = ble_gatts_notify_custom(conn_handle, hrs_hrm_handle, om);

	return rc;
}


void ble_svc_hrs_init(void)
{
    int rc;

    rc = ble_gatts_count_cfg(ble_svc_hrs_def);
	app_assert(rc == 0);

    rc = ble_gatts_add_svcs(ble_svc_hrs_def);
	app_assert(rc == 0);
}