/**
 * Copyright (c) 2013 - 2021, Nordic Semiconductor ASA
 *
 * 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, except as embedded into a Nordic
 *    Semiconductor ASA integrated circuit in a product or a software update for
 *    such product, 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 Nordic Semiconductor ASA nor the names of its
 *    contributors may be used to endorse or promote products derived from this
 *    software without specific prior written permission.
 *
 * 4. This software, with or without modification, must only be used with a
 *    Nordic Semiconductor ASA integrated circuit.
 *
 * 5. Any software provided in binary form under this license must not be reverse
 *    engineered, decompiled, modified and/or disassembled.
 *
 * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA 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.
 *
 */
#include "sdk_common.h"
#if NRF_MODULE_ENABLED(BLE_CS)
#include "ble_cs.h"
#include <string.h>
#include "ble_srv_common.h"
#include "ble_conn_state.h"
#include "nrf_log.h"
#include "nrf_log_ctrl.h"
#include "nrf_gpio.h"

void ble_cs_on_ble_evt(ble_evt_t const * p_ble_evt, void * p_context)
{
    ble_cs_t * p_cs = (ble_cs_t *)p_context;

    switch (p_ble_evt->header.evt_id)
    {
       
        default:
            // No implementation needed.
            break;
    }
}


uint32_t ble_cs_init(ble_cs_t * p_cs, const ble_cs_init_t * p_cs_init)
{
    if (p_cs == NULL || p_cs_init == NULL)
    {
        return NRF_ERROR_NULL;
    }
    
    uint32_t                err_code;
    ble_uuid_t              ble_uuid;
    ble_add_char_params_t   add_char_params;
    ble_add_descr_params_t  add_descr_params;
    uint8_t                 initial_mac_address;
    uint8_t                 initial_error_messages;
    uint8_t                 init_len;
    uint8_t                 encoded_report_ref[BLE_SRV_ENCODED_REPORT_REF_LEN];



    // Initialize service structure.
    p_cs->evt_handler = p_cs_init->evt_handler;
    p_cs->is_notification_supported = p_cs_init->support_notification;

    // Add service.
    ble_uuid128_t base_uuid = {CS_UUID_BASE};
    err_code = sd_ble_uuid_vs_add(&base_uuid, &p_cs->uuid_type);
    VERIFY_SUCCESS(err_code);

    ble_uuid.type = p_cs->uuid_type;
    ble_uuid.uuid = CS_UUID_SERVICE;

    err_code = sd_ble_gatts_service_add(BLE_GATTS_SRVC_TYPE_PRIMARY, &ble_uuid, &p_cs->service_handle);
    VERIFY_SUCCESS(err_code);

    // Add Mac Address characteristic.
    initial_mac_address = p_cs_init->mac_address;

    memset(&add_char_params, 0, sizeof(add_char_params));
    add_char_params.uuid              = CS_UUID_MAC_ADDRESS_CHAR;
    add_char_params.uuid_type         = p_cs->uuid_type;
    add_char_params.init_len          = sizeof(uint8_t);
    add_char_params.max_len           = sizeof(uint8_t);
    add_char_params.p_init_value      = &initial_mac_address;
    add_char_params.char_props.read   = 1;

    add_char_params.read_access       = SEC_OPEN;
    add_char_params.cccd_write_access = SEC_OPEN;

    err_code = characteristic_add(p_cs->service_handle,
                                  &add_char_params,
                                  &p_cs->mac_char_handles);
    if (err_code != NRF_SUCCESS)
    {
        return err_code;
    }

    // Add Error Messages characteristic.
    initial_error_messages = p_cs_init->initial_error_msg;

    memset(&add_char_params, 0, sizeof(add_char_params));
    add_char_params.uuid              = CS_UUID_ERROR_MESSAGES_CHAR;
    add_char_params.uuid_type         = p_cs->uuid_type;
    add_char_params.init_len          = sizeof(uint8_t);
    add_char_params.max_len           = sizeof(uint8_t);
    add_char_params.p_init_value      = &initial_error_messages;
    add_char_params.char_props.notify   = p_cs->is_notification_supported;

    //add_char_params.p_init_value      = &initial_error_messages;
    //add_char_params.char_props.read   = 1;

    add_char_params.read_access       = SEC_OPEN;
    add_char_params.cccd_write_access = SEC_OPEN;

    err_code = characteristic_add(p_cs->service_handle,
                                  &add_char_params,
                                  &p_cs->mac_char_handles);
    if (err_code != NRF_SUCCESS)
    {
        return err_code;
    }
}


static ret_code_t error_messages_send(ble_gatts_hvx_params_t * const p_hvx_params,  uint16_t conn_handle)
{
    ret_code_t err_code = sd_ble_gatts_hvx(conn_handle, p_hvx_params);
    if (err_code == NRF_SUCCESS)
    {
        NRF_LOG_INFO("Battery notification has been sent using conn_handle: 0x%04X", conn_handle);
    }
    else
    {
        NRF_LOG_DEBUG("Error: 0x%08X while sending notification with conn_handle: 0x%04X",
                      err_code,
                      conn_handle);
    }
    return err_code;
    
}


ret_code_t ble_cs_error_check_update(ble_cs_t * p_cs, uint8_t   error_messages, uint16_t   conn_handle)
{
    if (p_cs == NULL)
    {
        return NRF_ERROR_NULL;
    }

    ret_code_t         err_code = NRF_SUCCESS;
    ble_gatts_value_t  gatts_value;

    memset(&gatts_value, 0, sizeof(gatts_value));

    gatts_value.len     = sizeof(uint8_t);
    gatts_value.offset  = 0;
    gatts_value.p_value = &error_messages;

 

    // Send value if connected and notifying.
    if (p_cs->is_notification_supported)
    {
        ble_gatts_hvx_params_t hvx_params;

        memset(&hvx_params, 0, sizeof(hvx_params));

        hvx_params.handle = p_cs->error_char_handles.value_handle;
        hvx_params.type   = BLE_GATT_HVX_NOTIFICATION;
        hvx_params.offset = gatts_value.offset;
        hvx_params.p_len  = &gatts_value.len;
        hvx_params.p_data = gatts_value.p_value;

        if (conn_handle == BLE_CONN_HANDLE_ALL)
        {
             //nrf_gpio_pin_set(2);
            ble_conn_state_conn_handle_list_t conn_handles = ble_conn_state_conn_handles();

            // Try sending notifications to all valid connection handles.
            for (uint32_t i = 0; i < conn_handles.len; i++)
            {
            //nrf_gpio_pin_set(2);
                if (ble_conn_state_status(conn_handles.conn_handles[i]) == BLE_CONN_STATUS_CONNECTED)
                {
                    if (err_code == NRF_SUCCESS)
                    {
                        err_code = error_messages_send(&hvx_params,  conn_handles.conn_handles[i]);
                    }
                    else
                    {
                        // Preserve the first non-zero error code
                        UNUSED_RETURN_VALUE(error_messages_send(&hvx_params,  conn_handles.conn_handles[i]));
                    }
                }
            }
        }
        else
        {
            err_code = error_messages_send(&hvx_params, conn_handle);
        }
    }
    else
    {
        err_code = NRF_ERROR_INVALID_STATE;
    }

    return err_code;
}


#endif // NRF_MODULE_ENABLED(BLE_LBS)

