123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397 |
- #include <stdint.h>
- #include <string.h>
- #include "ble.h"
- #include "ble_srv_common.h"
- #include "cgms_sst.h"
- #include "cgms_socp.h"
- #include "nrf_ble_gq.h"
- #define NRF_BLE_CGMS_PLUS_INFINTE 0x07FE
- #define NRF_BLE_CGMS_MINUS_INFINTE 0x0802
- #define SOCP_OPCODE_RESERVED 0x00
- #define SOCP_WRITE_CGM_COMMUNICATION_INTERVAL 0x01
- #define SOCP_READ_CGM_COMMUNICATION_INTERVAL 0x02
- #define SOCP_READ_CGM_COMMUNICATION_INTERVAL_RESPONSE 0x03
- #define SOCP_WRITE_GLUCOSE_CALIBRATION_VALUE 0x04
- #define SOCP_READ_GLUCOSE_CALIBRATION_VALUE 0x05
- #define SOCP_READ_GLUCOSE_CALIBRATION_VALUE_RESPONSE 0x06
- #define SOCP_WRITE_PATIENT_HIGH_ALERT_LEVEL 0x07
- #define SOCP_READ_PATIENT_HIGH_ALERT_LEVEL 0x08
- #define SOCP_READ_PATIENT_HIGH_ALERT_LEVEL_RESPONSE 0x09
- #define SOCP_WRITE_PATIENT_LOW_ALERT_LEVEL 0x0A
- #define SOCP_READ_PATIENT_LOW_ALERT_LEVEL 0x0B
- #define SOCP_READ_PATIENT_LOW_ALERT_LEVEL_RESPONSE 0x0C
- #define SOCP_SET_HYPO_ALERT_LEVEL 0x0D
- #define SOCP_GET_HYPO_ALERT_LEVEL 0x0E
- #define SOCP_HYPO_ALERT_LEVEL_RESPONSE 0x0F
- #define SOCP_SET_HYPER_ALERT_LEVEL 0x10
- #define SOCP_GET_HYPER_ALERT_LEVEL 0x11
- #define SOCP_HYPER_ALERT_LEVEL_RESPONSE 0x12
- #define SOCP_SET_RATE_OF_DECREASE_ALERT_LEVEL 0x13
- #define SOCP_GET_RATE_OF_DECREASE_ALERT_LEVEL 0x14
- #define SOCP_RATE_OF_DECREASE_ALERT_LEVEL_RESPONSE 0x15
- #define SOCP_SET_RATE_OF_INCREASE_ALERT_LEVEL 0x16
- #define SOCP_GET_RATE_OF_INCREASE_ALERT_LEVEL 0x17
- #define SOCP_RATE_OF_INCREASE_ALERT_LEVEL_RESPONSE 0x18
- #define SOCP_RESET_DEVICE_SPECIFIC_ALERT 0x19
- #define SOCP_START_THE_SESSION 0x1A
- #define SOCP_STOP_THE_SESSION 0x1B
- #define SOCP_RESPONSE_CODE 0x1C
- #define SOCP_RSP_RESERVED_FOR_FUTURE_USE 0x00
- #define SOCP_RSP_SUCCESS 0x01
- #define SOCP_RSP_OP_CODE_NOT_SUPPORTED 0x02
- #define SOCP_RSP_INVALID_OPERAND 0x03
- #define SOCP_RSP_PROCEDURE_NOT_COMPLETED 0x04
- #define SOCP_RSP_OUT_OF_RANGE 0x05
- static void ble_socp_decode(uint8_t data_len, uint8_t const * p_data, ble_cgms_socp_value_t * p_socp_val)
- {
- p_socp_val->opcode = 0xFF;
- p_socp_val->operand_len = 0;
- p_socp_val->p_operand = NULL;
- if (data_len > 0)
- {
- p_socp_val->opcode = p_data[0];
- }
- if (data_len > 1)
- {
- p_socp_val->operand_len = data_len - 1;
- p_socp_val->p_operand = (uint8_t*)&p_data[1];
- }
- }
- uint8_t ble_socp_encode(const ble_socp_rsp_t * p_socp_rsp, uint8_t * p_data)
- {
- uint8_t len = 0;
- int i;
- if (p_data != NULL)
- {
- p_data[len++] = p_socp_rsp->opcode;
- if (
- (p_socp_rsp->opcode != SOCP_READ_CGM_COMMUNICATION_INTERVAL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_READ_PATIENT_HIGH_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_READ_PATIENT_LOW_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_HYPO_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_HYPER_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_RATE_OF_DECREASE_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_RATE_OF_INCREASE_ALERT_LEVEL_RESPONSE)
- && (p_socp_rsp->opcode != SOCP_READ_GLUCOSE_CALIBRATION_VALUE_RESPONSE)
- )
- {
- p_data[len++] = p_socp_rsp->req_opcode;
- p_data[len++] = p_socp_rsp->rsp_code;
- }
- for (i = 0; i < p_socp_rsp->size_val; i++)
- {
- p_data[len++] = p_socp_rsp->resp_val[i];
- }
- }
- return len;
- }
- ret_code_t cgms_socp_char_add(nrf_ble_cgms_t * p_cgms)
- {
- ble_add_char_params_t add_char_params;
- memset(&add_char_params, 0, sizeof(add_char_params));
- add_char_params.uuid = BLE_UUID_CGM_SPECIFIC_OPS_CTRLPT;
- add_char_params.max_len = BLE_GATT_ATT_MTU_DEFAULT;
- add_char_params.init_len = 0;
- add_char_params.p_init_value = 0;
- add_char_params.is_var_len = true;
- add_char_params.char_props.indicate = true;
- add_char_params.char_props.write = true;
- add_char_params.write_access = SEC_JUST_WORKS;
- add_char_params.cccd_write_access = SEC_JUST_WORKS;
- add_char_params.is_defered_write = 1;
- return characteristic_add(p_cgms->service_handle,
- &add_char_params,
- &p_cgms->char_handles.socp);
- }
- static void socp_send(nrf_ble_cgms_t * p_cgms)
- {
- uint32_t err_code;
- uint8_t encoded_resp[25];
- uint16_t len;
- nrf_ble_gq_req_t cgms_req;
- memset(&cgms_req, 0, sizeof(nrf_ble_gq_req_t));
-
- len = ble_socp_encode(&(p_cgms->socp_response), encoded_resp);
- cgms_req.type = NRF_BLE_GQ_REQ_GATTS_HVX;
- cgms_req.error_handler.cb = p_cgms->gatt_err_handler;
- cgms_req.error_handler.p_ctx = p_cgms;
- cgms_req.params.gatts_hvx.type = BLE_GATT_HVX_INDICATION;
- cgms_req.params.gatts_hvx.handle = p_cgms->char_handles.socp.value_handle;
- cgms_req.params.gatts_hvx.offset = 0;
- cgms_req.params.gatts_hvx.p_data = encoded_resp;
- cgms_req.params.gatts_hvx.p_len = &len;
- err_code = nrf_ble_gq_item_add(p_cgms->p_gatt_queue, &cgms_req, p_cgms->conn_handle);
-
- if ((p_cgms->error_handler != NULL) &&
- (err_code != NRF_SUCCESS) &&
- (err_code != NRF_ERROR_INVALID_STATE))
- {
- p_cgms->error_handler(err_code);
- }
- }
- void encode_get_response(uint8_t rsp_code, ble_socp_rsp_t * p_rsp, uint16_t in_val)
- {
- p_rsp->opcode = rsp_code;
- p_rsp->rsp_code = SOCP_RSP_SUCCESS;
- p_rsp->size_val += uint16_encode(in_val, &(p_rsp->resp_val[p_rsp->size_val]));
- }
- void decode_set_opcode(nrf_ble_cgms_t * p_cgms,
- ble_cgms_socp_value_t * rcv_val,
- uint16_t min,
- uint16_t max,
- uint16_t * p_val)
- {
- uint16_t rcvd_val = uint16_decode(rcv_val->p_operand);
- if ((rcvd_val == NRF_BLE_CGMS_PLUS_INFINTE)
- || (rcvd_val == NRF_BLE_CGMS_MINUS_INFINTE)
- || (rcvd_val > max)
- || (rcvd_val < min))
- {
- p_cgms->socp_response.rsp_code = SOCP_RSP_OUT_OF_RANGE;
- }
- else
- {
- p_cgms->socp_response.rsp_code = SOCP_RSP_SUCCESS;
- *p_val = rcvd_val;
- }
- }
- static bool is_feature_present(nrf_ble_cgms_t * p_cgms, uint32_t feature)
- {
- return (p_cgms->feature.feature & feature);
- }
- static void on_socp_value_write(nrf_ble_cgms_t * p_cgms, ble_gatts_evt_write_t const * p_evt_write)
- {
- ble_cgms_socp_value_t socp_request;
- nrf_ble_cgms_evt_t evt;
- ble_gatts_rw_authorize_reply_params_t auth_reply;
- uint32_t err_code;
- memset(&auth_reply, 0, sizeof(auth_reply));
- auth_reply.type = BLE_GATTS_AUTHORIZE_TYPE_WRITE;
- auth_reply.params.write.gatt_status = BLE_GATT_STATUS_SUCCESS;
- auth_reply.params.write.update = 1;
- err_code = sd_ble_gatts_rw_authorize_reply(p_cgms->conn_handle, &auth_reply);
- if (err_code != NRF_SUCCESS)
- {
- if (p_cgms->error_handler != NULL)
- {
- p_cgms->error_handler(err_code);
- }
- return;
- }
-
- ble_socp_decode(p_evt_write->len, p_evt_write->data, &socp_request);
- p_cgms->socp_response.opcode = SOCP_RESPONSE_CODE;
- p_cgms->socp_response.req_opcode = socp_request.opcode;
- p_cgms->socp_response.rsp_code = SOCP_RSP_OP_CODE_NOT_SUPPORTED;
- p_cgms->socp_response.size_val = 0;
- switch (socp_request.opcode)
- {
- case SOCP_WRITE_CGM_COMMUNICATION_INTERVAL:
- p_cgms->socp_response.rsp_code = SOCP_RSP_SUCCESS;
- p_cgms->comm_interval = socp_request.p_operand[0];
- evt.evt_type = NRF_BLE_CGMS_EVT_WRITE_COMM_INTERVAL;
- p_cgms->evt_handler(p_cgms, &evt);
- break;
- case SOCP_READ_CGM_COMMUNICATION_INTERVAL:
- p_cgms->socp_response.opcode = SOCP_READ_CGM_COMMUNICATION_INTERVAL_RESPONSE;
- p_cgms->socp_response.resp_val[0] = p_cgms->comm_interval;
- p_cgms->socp_response.size_val++;
- break;
- case SOCP_START_THE_SESSION:
- if (p_cgms->is_session_started)
- {
- p_cgms->socp_response.rsp_code = SOCP_RSP_PROCEDURE_NOT_COMPLETED;
- }
- else if ((p_cgms->nb_run_session != 0) &&
- !(is_feature_present(p_cgms, NRF_BLE_CGMS_FEAT_MULTIPLE_SESSIONS_SUPPORTED)))
- {
- p_cgms->socp_response.rsp_code = SOCP_RSP_PROCEDURE_NOT_COMPLETED;
- }
- else
- {
- p_cgms->socp_response.rsp_code = SOCP_RSP_SUCCESS;
- p_cgms->is_session_started = true;
- p_cgms->nb_run_session++;
- if (p_cgms->evt_handler != NULL)
- {
- evt.evt_type = NRF_BLE_CGMS_EVT_START_SESSION;
- p_cgms->evt_handler(p_cgms, &evt);
- }
- ble_cgms_sst_t sst;
- memset(&sst, 0, sizeof(ble_cgms_sst_t));
- err_code = cgms_sst_set(p_cgms, &sst);
- if (err_code != NRF_SUCCESS)
- {
- if (p_cgms->error_handler != NULL)
- {
- p_cgms->error_handler(err_code);
- }
- }
- p_cgms->sensor_status.time_offset = 0;
- p_cgms->sensor_status.status.status &= (~NRF_BLE_CGMS_STATUS_SESSION_STOPPED);
- err_code = nrf_ble_cgms_update_status(p_cgms, &p_cgms->sensor_status);
- if (err_code != NRF_SUCCESS)
- {
- if (p_cgms->error_handler != NULL)
- {
- p_cgms->error_handler(err_code);
- }
- }
- }
- break;
- case SOCP_STOP_THE_SESSION:
- {
- nrf_ble_cgm_status_t status;
- memset(&status, 0, sizeof(nrf_ble_cgm_status_t));
- p_cgms->evt_handler(p_cgms, &evt);
- p_cgms->socp_response.rsp_code = SOCP_RSP_SUCCESS;
- p_cgms->is_session_started = false;
- status.time_offset = p_cgms->sensor_status.time_offset;
- status.status.status = p_cgms->sensor_status.status.status |
- NRF_BLE_CGMS_STATUS_SESSION_STOPPED;
- if (p_cgms->evt_handler != NULL)
- {
- evt.evt_type = NRF_BLE_CGMS_EVT_STOP_SESSION;
- p_cgms->evt_handler(p_cgms, &evt);
- }
- err_code = nrf_ble_cgms_update_status(p_cgms, &status);
- if (err_code != NRF_SUCCESS)
- {
- if (p_cgms->error_handler != NULL)
- {
- p_cgms->error_handler(err_code);
- }
- }
- break;
- }
- default:
- p_cgms->socp_response.rsp_code = SOCP_RSP_OP_CODE_NOT_SUPPORTED;
- break;
- }
- socp_send(p_cgms);
- }
- void cgms_socp_on_rw_auth_req(nrf_ble_cgms_t * p_cgms,
- ble_gatts_evt_rw_authorize_request_t const * p_auth_req)
- {
- if (p_auth_req->type == BLE_GATTS_AUTHORIZE_TYPE_WRITE)
- {
- if (p_auth_req->request.write.handle == p_cgms->char_handles.socp.value_handle)
- {
- on_socp_value_write(p_cgms, &p_auth_req->request.write);
- }
- }
- }
|