#include <string.h>
#include "bas.h"

#include "host/ble_hs.h"
#include "host/ble_gap.h"

#include "app_log.h"


static uint16_t ble_svc_bas_battery_handle;

/* Battery level */
uint8_t ble_svc_bas_battery_level = 100;

static int ble_svc_bas_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_bas_defs[] =
{
    {
        /*** Battery Service. */
        .type = BLE_GATT_SVC_TYPE_PRIMARY,
        .uuid = BLE_UUID16_DECLARE(BLE_SVC_BAS_UUID16),
        .characteristics = (struct ble_gatt_chr_def[])
		{
        	{
        		/*** Battery level characteristic */
				.uuid = BLE_UUID16_DECLARE(BLE_SVC_BAS_CHR_UUID16_BATTERY_LEVEL),
				.access_cb = ble_svc_bas_access,
				.val_handle = &ble_svc_bas_battery_handle,
				.flags = BLE_GATT_CHR_F_READ |BLE_GATT_CHR_F_NOTIFY ,
        	},
        	{
        		0, /* No more characteristics in this service. */
        	}
        },
    },
    {
        0, /* No more services. */
    },
};


static int ble_svc_bas_access(uint16_t conn_handle, uint16_t attr_handle,
							  struct ble_gatt_access_ctxt *ctxt, void *arg)
{
    uint16_t uuid16 = ble_uuid_u16(ctxt->chr->uuid);
    int rc;

    switch (uuid16)
    {
    case BLE_SVC_BAS_CHR_UUID16_BATTERY_LEVEL:
        app_assert(ctxt->op == BLE_GATT_ACCESS_OP_READ_CHR);
        rc = os_mbuf_append(ctxt->om, &ble_svc_bas_battery_level, sizeof ble_svc_bas_battery_level);
        return rc == 0 ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;

    default:
        app_assert(0);
        return BLE_ATT_ERR_UNLIKELY;
    }
}

int ble_svc_bas_battery_level_set(uint8_t level)
{
    if(level > 100){
    	level = 100;
    }

    if(ble_svc_bas_battery_level != level)
    {
    	ble_svc_bas_battery_level = level;
        ble_gatts_chr_updated(ble_svc_bas_battery_handle);
    }
    return 0;
}

void ble_svc_bas_init(void)
{
    int rc;

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

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