void gzp_init()
{
gzp_id_req_pending = false;
#ifndef GZP_NV_STORAGE_DISABLE
(void)gzp_params_restore();
#endif
// Update radio parameters from gzp_system_address
(void)gzp_update_radio_params(gzp_system_address);
}
void gzp_init()
{
uint8_t system_address[GZP_SYSTEM_ADDRESS_WIDTH];
// Read "chip id", of which 4 bytes (GZP_SYSTEM_ADDRESS_WIDTH)
// are used as system address
gzp_host_chip_id_read(system_address, GZP_SYSTEM_ADDRESS_WIDTH);
// Set up radio parameters (addresses and channel subset) from system_address
gzp_update_radio_params(system_address);
// Only "data pipe" enabled by default
gzll_set_param(GZLL_PARAM_RX_PIPES, gzll_get_param(GZLL_PARAM_RX_PIPES) | (1 << GZP_DATA_PIPE));
gzp_pairing_enabled_f = false;
gzp_address_exchanged_f = false;
gzp_id_req_stat = GZP_ID_REQ_IDLE;
gzp_encrypted_user_data_length = 0;
// Infinite RX timeout
gzll_set_param(GZLL_PARAM_RX_TIMEOUT, 0);
}
bool gzp_address_req_send()
{
//lint -save -e514 Unusual use of a Boolean expression (gzll_update_ok &= ...)
uint8_t i;
bool retval = false;
bool success;
uint8_t address_req[GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH];
uint8_t rx_payload[NRF_GZLL_CONST_MAX_PAYLOAD_LENGTH];
uint32_t rx_payload_length = NRF_GZLL_CONST_MAX_PAYLOAD_LENGTH;
nrf_gzll_tx_power_t temp_power;
uint32_t temp_max_tx_attempts;
bool gzll_update_ok = true;
// Store parameters that are temporarily changed
temp_max_tx_attempts = nrf_gzll_get_max_tx_attempts();
temp_power = nrf_gzll_get_tx_power();
// Modify parameters
nrf_gzp_disable_gzll();
gzll_update_ok &= nrf_gzll_set_max_tx_attempts(GZP_REQ_TX_TIMEOUT);
gzll_update_ok &= nrf_gzll_set_tx_power(GZP_POWER);
// Flush RX FIFO
gzll_update_ok &= nrf_gzll_flush_rx_fifo(GZP_PAIRING_PIPE);
gzll_update_ok &= nrf_gzll_enable();
// Build "request" packet
address_req[0] = (uint8_t)GZP_CMD_HOST_ADDRESS_REQ;
// Send a number of packets in order to broadcast that devices not within
// close proximity must back off.
for(i = 0; i < GZP_MAX_BACKOFF_PACKETS; i++)
{
success = gzp_tx_packet(address_req, GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH, GZP_PAIRING_PIPE);
if(success)
{
nrf_gzp_flush_rx_fifo(GZP_PAIRING_PIPE);
}
else
{
break;
}
}
gzp_delay_rx_periods(GZP_TX_ACK_WAIT_TIMEOUT);
// Send message for fetching pairing response from host.
address_req[0] = (uint8_t)GZP_CMD_HOST_ADDRESS_FETCH;
success = gzp_tx_packet(address_req, GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH, GZP_PAIRING_PIPE);
if(success && latest_tx_info.payload_received_in_ack)
{
// If pairing response received
if(nrf_gzll_get_rx_fifo_packet_count(GZP_PAIRING_PIPE) > 0)
{
rx_payload_length = NRF_GZLL_CONST_MAX_PAYLOAD_LENGTH; //dummy placeholder
if(nrf_gzll_fetch_packet_from_rx_fifo(GZP_PAIRING_PIPE, rx_payload, &rx_payload_length))
{
if(rx_payload[0] == (uint8_t)GZP_CMD_HOST_ADDRESS_RESP)
{
memcpy(gzp_system_address, &rx_payload[GZP_CMD_HOST_ADDRESS_RESP_ADDRESS], GZP_SYSTEM_ADDRESS_WIDTH);
gzll_update_ok &= gzp_update_radio_params(&rx_payload[GZP_CMD_HOST_ADDRESS_RESP_ADDRESS]);
#ifndef GZP_NV_STORAGE_DISABLE
(void)gzp_params_store(false); // "False" indicates that only "system address" part of DB element will be stored
#endif
retval = true;
}
}
}
}
else
{
gzp_delay_rx_periods(GZP_NOT_PROXIMITY_BACKOFF_RX_TIMEOUT - GZP_TX_ACK_WAIT_TIMEOUT);
}
gzp_delay_rx_periods(GZP_STEP1_RX_TIMEOUT);
// Clean-up and restore parameters temporarily modified
nrf_gzp_disable_gzll();
gzll_update_ok &= nrf_gzll_flush_rx_fifo(GZP_PAIRING_PIPE);
gzll_update_ok &= nrf_gzll_flush_tx_fifo(GZP_PAIRING_PIPE);
gzll_update_ok &= nrf_gzll_set_max_tx_attempts(temp_max_tx_attempts);
gzll_update_ok &= nrf_gzll_set_tx_power(temp_power);
gzll_update_ok &= nrf_gzll_enable();
if(!gzll_update_ok)
{
/*
The update of the Gazell parameters failed. Use nrf_gzll_get_error_code()
to investigate the cause.
*/
}
return retval;
//lint -restore
}
void gzp_update_system_address(uint8_t *sys_addr)
{
memcpy(gzp_system_address, sys_addr, GZP_SYSTEM_ADDRESS_WIDTH);
gzp_update_radio_params(sys_addr);
return;
}
bool gzp_address_req_send(uint8_t idx)
{
uint8_t i;
bool retval = false;
uint8_t address_req[GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH];
uint8_t rx_payload[GZLL_MAX_PAYLOAD_LENGTH];
uint16_t temp_power, temp_tx_timeout, temp_device_mode;
if(gzll_get_state() == GZLL_IDLE)
{
// Store parameters that are temporarily changed
temp_tx_timeout = gzll_get_param(GZLL_PARAM_TX_TIMEOUT);
temp_power = gzll_get_param(GZLL_PARAM_OUTPUT_POWER);
temp_device_mode = gzll_get_param(GZLL_PARAM_DEVICE_MODE);
// Modify parameters
gzll_set_param(GZLL_PARAM_TX_TIMEOUT, GZP_REQ_TX_TIMEOUT);
gzll_set_param(GZLL_PARAM_OUTPUT_POWER, GZP_POWER);
gzll_set_param(GZLL_PARAM_DEVICE_MODE, 0);
// Flush RX FIFO
gzll_rx_fifo_flush();
// Build "request" packet
address_req[0] = GZP_CMD_HOST_ADDRESS_REQ;
// Send a number of packets in order to broadcast that devices not within
// close proximity must back off.
for(i = 0; i < GZP_MAX_BACKOFF_PACKETS; i++)
{
if(!gzp_tx_packet(address_req, GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH, 0))
{
break;
}
}
gzp_delay_rx_periods(GZP_TX_ACK_WAIT_TIMEOUT);
// Send message for fetching pairing response from host.
address_req[0] = GZP_CMD_HOST_ADDRESS_FETCH;
if(gzp_tx_packet(&address_req[0], GZP_CMD_HOST_ADDRESS_REQ_PAYLOAD_LENGTH, 0))
{
// If pairing response received
if(gzll_rx_fifo_read(rx_payload, NULL, NULL))
{
if(rx_payload[0] == GZP_CMD_HOST_ADDRESS_RESP)
{
memcpy(gzp_system_address, &rx_payload[GZP_CMD_HOST_ADDRESS_RESP_ADDRESS], GZP_SYSTEM_ADDRESS_WIDTH);
gzp_update_radio_params(&rx_payload[GZP_CMD_HOST_ADDRESS_RESP_ADDRESS]);
pairing_list_addr_write(idx, gzp_system_address);
retval = true;
}
}
}
else
{
gzp_delay_rx_periods(GZP_NOT_PROXIMITY_BACKOFF_RX_TIMEOUT - GZP_TX_ACK_WAIT_TIMEOUT);
}
gzp_delay_rx_periods(GZP_STEP1_RX_TIMEOUT);
// Clean-up and restore parameters temporarily modified
gzll_rx_fifo_flush();
gzll_tx_fifo_flush();
gzll_set_param(GZLL_PARAM_TX_TIMEOUT, temp_tx_timeout);
gzll_set_param(GZLL_PARAM_OUTPUT_POWER, temp_power);
gzll_set_param(GZLL_PARAM_DEVICE_MODE, temp_device_mode);
}
return retval;
}
