void pal_nvm_multi_write32(uint8_t var_id, uint32_t *value)
{
bool clear = false;
// Check if current flash address is the last one of the flash section used for this variable.
if (var_addr[var_id] == (NVM_MULTI_WRITE_START +
((var_id +1) * NVM_MULTI_WRITE_NUM_PG_PER_VAR * SPM_PAGESIZE) - sizeof(uint32_t)))
{
// Entire flash area for this variable is in use; clear flash pages used for this variable
clear = true;
}
else
{
// Assign next storage location
var_addr[var_id] += sizeof(uint32_t);
}
if (clear)
{
nvm_var_clear(var_id);
var_addr[var_id] = NVM_MULTI_WRITE_START + (var_id * NVM_MULTI_WRITE_NUM_PG_PER_VAR * SPM_PAGESIZE);
}
// Write new value to page buffer
flash_fill_page_buffer((var_addr[var_id] % SPM_PAGESIZE), sizeof(uint32_t), (uint8_t*)value);
// Write page buffer to actual flash page
flash_write_page(var_addr[var_id]);
}
void pal_nvm_multi_init(uint8_t var_id)
{
nvm_var_clear(var_id); // Erase/Clear entire flash page
uint32_t value = 0x00000000; // Set the first value to 0x00000000
// Write first value to page buffer
var_addr[var_id] = NVM_MULTI_WRITE_START + (var_id * NVM_MULTI_WRITE_NUM_PG_PER_VAR * SPM_PAGESIZE);
flash_fill_page_buffer(0, sizeof(uint32_t), (uint8_t *)&value);
// Write page buffer to actual flash page
flash_write_page(var_addr[var_id]);
}
void vendor_data_ind(uint8_t PairingRef, profile_id_t ProfileId, uint16_t VendorId,
uint8_t nsduLength, uint8_t *nsdu, uint8_t RxLinkQuality,
uint8_t RxFlags)
{
/* Check if vendor id matches.
Handle here only vendor data from same vendor */
uint16_t v_id = PGM_READ_WORD(&VendorIdentifier);
if ((VendorId == v_id) && (RxFlags & RX_FLAG_WITH_SEC))
{
switch (nsdu[0]) // vendor-specific command id
{
#ifdef _DEBUG_INTERFACE_
case 0x1B:
{
int i;
for (i = 0; i < nsduLength;)
{
RxHandler(nsdu[i++]);
}
RX_index = 4; // Next GetChar() will get the command id
/* Call QDebug_Process */
QDebug_ProcessCommands();
return;
}
break;
#endif
#ifdef TFA_BAT_MON
case BATTERY_STATUS_REQ:
{
uint16_t voltage = tfa_get_batmon_voltage();
nsdu[0] = BATTERY_STATUS_RESP;
nsdu[1] = (uint8_t)voltage; // LSB
nsdu[2] = (uint8_t)(voltage >> 8); // MSB
nsduLength = 3;
}
break;
#endif
case ALIVE_REQ: /* Alive request */
vendor_app_alive_req();
/* Send alive response */
nsdu[0] = ALIVE_RESP;
nsduLength = 1;
break;
case FW_VERSION_REQ:
{
/* Send alive response */
nsdu[0] = FW_VERSION_RESP;
nsdu[1] = FW_VERSION_MAJOR; // major version number
nsdu[2] = FW_VERSION_MINOR; // minor version number
nsdu[3] = FW_VERSION_REV; // revision version number
nsduLength = 4;
}
break;
case RX_ON_REQ:
{
uint32_t duration = 0;
memcpy(&duration, &nsdu[1], 3);
if (!nlme_rx_enable_request(duration))
{
/*
* RX enable could not been added to the queue.
* Therefore do not send response message.
*/
return;
}
/* Send response */
nsdu[0] = RX_ON_RESP;
nsduLength = 1;
}
break;
#ifdef FLASH_SUPPORT
case FW_DATA_REQ:
{
fw_data_frame_t *fw_frame;
vendor_status_t status = VD_SUCCESS;
fw_frame = (fw_data_frame_t *)nsdu;
/* Verify data chunk size */
uint8_t fw_data_size = nsduLength - 5; // 5 = header len
if (fw_data_size > 64)
{
status = VD_UNSUPPORTED_SIZE;
}
else
{
/* Fill temporary page buffer */
uint16_t start_addr = (fw_frame->frame_cnt - 1) % 4;
flash_fill_page_buffer(start_addr * (SPM_PAGESIZE / 4), fw_data_size, &fw_frame->fw_data[0]);
/* Write flash page */
if ((fw_frame->frame_cnt % 4) == 0)
{
uint32_t page_start_addr;
page_start_addr = IMAGE_START_ADDR + ((uint32_t)SPM_PAGESIZE * ((fw_frame->frame_cnt / 4) - 1));
flash_program_page(page_start_addr);
}
else if (fw_frame->frame_cnt == fw_frame->total_num_frames)
{
uint32_t page_start_addr;
page_start_addr = IMAGE_START_ADDR + ((uint32_t)SPM_PAGESIZE * (fw_frame->frame_cnt / 4));
flash_program_page(page_start_addr);
}
}
/* Send response */
nsdu[0] = FW_DATA_RESP;
nsdu[1] = status;
nsduLength = 2;
}
break;
#endif /* #ifdef FLASH_SUPPORT */
#ifdef FLASH_SUPPORT
case FW_SWAP_REQ:
flash_swap(IMAGE_START_ADDR, IMAGE_SIZE);
/* Do not send response message */
return;
#endif /* #ifdef FLASH_SUPPORT */
default:
{
/* Send response */
nsdu[0] = FW_DATA_RESP;
nsdu[1] = VD_NOT_SUPPORTED_ATTRIBUTE;
nsduLength = 2;
}
break;
}
/* Transmit response message */
nlde_data_request(PairingRef, PROFILE_ID_VENDOR_DATA, VendorId,
nsduLength, nsdu,
TXO_UNICAST | TXO_DST_ADDR_NET | TXO_ACK_REQ | TXO_SEC_REQ | TXO_MULTI_CH | TXO_CH_NOT_SPEC | TXO_VEND_SPEC);
/* Keep compiler happy */
UNUSED(ProfileId);
UNUSED(RxLinkQuality);
UNUSED(RxFlags);
}
}