uint32_t ble_opt_set_req_enc(uint32_t const opt_id, ble_opt_t const * const p_opt, uint8_t * const p_buf, uint32_t * const p_buf_len) { uint32_t index = 0; uint32_t err_code = NRF_SUCCESS; SER_ASSERT_NOT_NULL(p_buf); SER_ASSERT_NOT_NULL(p_buf_len); uint32_t initial_buf_len = *p_buf_len; SER_ASSERT_LENGTH_LEQ(1 + 4 + 1, initial_buf_len); SER_ASSERT(((opt_id == BLE_COMMON_OPT_RADIO_CPU_MUTEX) || (opt_id == BLE_GAP_OPT_CH_MAP) || (opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) || (opt_id == BLE_GAP_OPT_PASSKEY) || (opt_id == BLE_GAP_OPT_PRIVACY) || (opt_id == BLE_GAP_OPT_SCAN_REQ_REPORT) || (opt_id == BLE_GAP_OPT_COMPAT_MODE)), NRF_ERROR_INVALID_PARAM); p_buf[index++] = SD_BLE_OPT_SET; err_code = uint32_t_enc(&opt_id, p_buf, initial_buf_len, &index); SER_ASSERT(err_code == NRF_SUCCESS, err_code); if (p_opt != NULL) { p_buf[index++] = SER_FIELD_PRESENT; switch(opt_id) { case BLE_COMMON_OPT_RADIO_CPU_MUTEX: err_code = ble_common_opt_radio_cpu_mutex_t_enc(&(p_opt->common_opt.radio_cpu_mutex),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_CH_MAP: err_code = ble_gap_opt_ch_map_t_enc(&(p_opt->gap_opt.ch_map),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_LOCAL_CONN_LATENCY: err_code = ble_gap_opt_local_conn_latency_t_enc(&(p_opt->gap_opt.local_conn_latency),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_PASSKEY: err_code = ble_gap_opt_passkey_t_enc(&(p_opt->gap_opt.passkey),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_PRIVACY: err_code = ble_gap_opt_privacy_t_enc(&(p_opt->gap_opt.privacy),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_SCAN_REQ_REPORT: err_code = ble_gap_opt_scan_req_report_t_enc(&(p_opt->gap_opt.scan_req_report),p_buf, initial_buf_len, &index); break; case BLE_GAP_OPT_COMPAT_MODE: err_code = ble_gap_opt_compat_mode_t_enc(&(p_opt->gap_opt.compat_mode),p_buf, initial_buf_len, &index); break; } } else { p_buf[index++] = SER_FIELD_NOT_PRESENT; } if (err_code != NRF_SUCCESS) { return err_code; } *p_buf_len = index; return err_code; }
uint32_t ble_opt_get_rsp_enc(uint32_t return_code, uint8_t * const p_buf, uint32_t * const p_buf_len, uint32_t opt_id, ble_opt_t const * const p_opt) { SER_ASSERT_NOT_NULL(p_buf); SER_ASSERT_NOT_NULL(p_buf_len); uint32_t total_len = *p_buf_len; uint32_t err_code = ser_ble_cmd_rsp_status_code_enc(SD_BLE_OPT_GET, return_code, p_buf, p_buf_len); if (err_code != NRF_SUCCESS) { return err_code; } if (return_code != NRF_SUCCESS) { return NRF_SUCCESS; } SER_ASSERT_NOT_NULL(p_opt); SER_ASSERT(((opt_id == BLE_COMMON_OPT_RADIO_CPU_MUTEX) || (opt_id == BLE_GAP_OPT_CH_MAP) || (opt_id == BLE_GAP_OPT_LOCAL_CONN_LATENCY) || (opt_id == BLE_GAP_OPT_PASSKEY) || (opt_id == BLE_GAP_OPT_PRIVACY) || (opt_id == BLE_GAP_OPT_SCAN_REQ_REPORT) || (opt_id == BLE_GAP_OPT_COMPAT_MODE)), NRF_ERROR_INVALID_PARAM); uint32_t index = *p_buf_len; err_code = uint32_t_enc(&opt_id, p_buf, total_len, &index); if (err_code != NRF_SUCCESS) { return err_code; } switch (opt_id) { case BLE_COMMON_OPT_RADIO_CPU_MUTEX: err_code = ble_common_opt_radio_cpu_mutex_t_enc((void *)&(p_opt->common_opt.radio_cpu_mutex), p_buf, total_len, &index); break; case BLE_GAP_OPT_CH_MAP: err_code = ble_gap_opt_ch_map_t_enc((void *)&(p_opt->gap_opt.ch_map), p_buf, total_len, &index); break; case BLE_GAP_OPT_LOCAL_CONN_LATENCY: err_code = ble_gap_opt_local_conn_latency_t_enc((void *)&(p_opt->gap_opt.local_conn_latency), p_buf, total_len, &index); break; case BLE_GAP_OPT_PASSKEY: err_code = ble_gap_opt_passkey_t_enc((void *)&(p_opt->gap_opt.passkey), p_buf, total_len, &index); break; case BLE_GAP_OPT_PRIVACY: err_code = ble_gap_opt_privacy_t_enc((void *)&(p_opt->gap_opt.privacy), p_buf, total_len, &index); break; case BLE_GAP_OPT_SCAN_REQ_REPORT: err_code = ble_gap_opt_scan_req_report_t_enc((void *)&(p_opt->gap_opt.scan_req_report), p_buf, total_len, &index); break; case BLE_GAP_OPT_COMPAT_MODE: err_code = ble_gap_opt_compat_mode_t_enc((void *)&(p_opt->gap_opt.compat_mode), p_buf, total_len, &index); break; } if (err_code != NRF_SUCCESS) { return err_code; } *p_buf_len = index; return NRF_SUCCESS; }