int main(void) {
// Initialize the OSS-7 Stack
system_init();
// Currently we address the Transport Layer, this should go to an upper layer once it is working.
trans_init();
trans_set_tx_callback(&tx_callback);
// The initial Tca for the CSMA-CA in
trans_set_initial_t_ca(200);
event.next_event = SEND_INTERVAL_MS;
event.f = &start_tx;
log_print_string("endpoint started");
timer_add_event(&event);
// Log the device id
log_print_data(device_id, 8);
system_watchdog_init(WDTSSEL0, 0x03);
system_watchdog_timer_start();
while(1)
{
if (add_tx_event)
{
add_tx_event = false;
timer_add_event(&event);
}
system_lowpower_mode(3,1);
}
}
void rx_callback(Trans_Rx_Query_Result* rx_res)
{
system_watchdog_timer_reset();
blink_led();
dll_foreground_frame_t* frame = (dll_foreground_frame_t*) (rx_res->nwl_rx_res->dll_rx_res->frame);
log_print_string("Received Query from :%x%x%x%x%x%x%x%x%x%x%x%x%x%x%x;",
frame->address_ctl->source_id[0] >> 4, frame->address_ctl->source_id[0] & 0x0F,
frame->address_ctl->source_id[1] >> 4, frame->address_ctl->source_id[1] & 0x0F,
frame->address_ctl->source_id[2] >> 4, frame->address_ctl->source_id[2] & 0x0F,
frame->address_ctl->source_id[3] >> 4, frame->address_ctl->source_id[3] & 0x0F,
frame->address_ctl->source_id[4] >> 4, frame->address_ctl->source_id[4] & 0x0F,
frame->address_ctl->source_id[5] >> 4, frame->address_ctl->source_id[5] & 0x0F,
frame->address_ctl->source_id[6] >> 4, frame->address_ctl->source_id[6] & 0x0F,
frame->address_ctl->source_id[7] >> 4, frame->address_ctl->source_id[7] & 0x0F);
log_print_string("RSS: %d dBm", rx_res->nwl_rx_res->dll_rx_res->rssi);
log_print_string("Netto Link: %d dBm", rx_res->nwl_rx_res->dll_rx_res->rssi - frame->frame_header.tx_eirp);
switch (rx_res->d7aqp_command.command_code & 0x0F)
{
case D7AQP_OPCODE_ANNOUNCEMENT_FILE:
{
D7AQP_Single_File_Return_Template* sfr_tmpl = (D7AQP_Single_File_Return_Template*) rx_res->d7aqp_command.command_data;
log_print_string("D7AQP File Announcement received");
log_print_string(" - file 0x%x starting from byte %d", sfr_tmpl->return_file_id, sfr_tmpl->file_offset);
log_print_data(sfr_tmpl->file_data, sfr_tmpl->isfb_total_length - sfr_tmpl->file_offset);
log_print_string(" isfb_total_length %d", sfr_tmpl->isfb_total_length);
}
}
if (rx_res->d7aqp_command.command_extension & D7AQP_COMMAND_EXTENSION_NORESPONSE)
{
// Restart channel scanning
start_channel_scan = true;
} else {
// send ack
// todo: put outside interrupt
// todo: use dialog template
command.command_code = D7AQP_COMMAND_CODE_EXTENSION | D7AQP_COMMAND_TYPE_RESPONSE | D7AQP_OPCODE_ANNOUNCEMENT_FILE;
command.command_extension = D7AQP_COMMAND_EXTENSION_NORESPONSE;
command.dialog_template = NULL;
command.command_data = NULL;
led_on(3);
trans_tx_query(&command, 0xFF, RECEIVE_CHANNEL, TX_EIRP);
}
}
void packet_disassemble(packet_t* packet)
{
log_print_data(packet->hw_radio_packet.data, packet->hw_radio_packet.length + 1); // TODO tmp
uint16_t crc = __builtin_bswap16(crc_calculate(packet->hw_radio_packet.data, packet->hw_radio_packet.length - 2));
if(memcmp(&crc, packet->hw_radio_packet.data + packet->hw_radio_packet.length + 1 - 2, 2) != 0)
{
DPRINT(LOG_STACK_DLL, "CRC invalid");
goto cleanup;
}
uint8_t data_idx = 1;
if(!dll_disassemble_packet_header(packet, &data_idx))
{
DPRINT(LOG_STACK_DLL, "disassemble header failed");
goto cleanup;
}
// TODO assuming D7ANP for now
if(!d7anp_disassemble_packet_header(packet, &data_idx))
{
DPRINT(LOG_STACK_NWL, "disassemble header failed");
goto cleanup;
}
if(!d7atp_disassemble_packet_header(packet, &data_idx))
{
DPRINT(LOG_STACK_TRANS, "disassemble header failed");
goto cleanup;
}
// TODO footers
// extract payload
packet->payload_length = packet->hw_radio_packet.length + 1 - data_idx - 2; // exclude the headers CRC bytes // TODO exclude footers
memcpy(packet->payload, packet->hw_radio_packet.data + data_idx, packet->payload_length);
DPRINT(LOG_STACK_FWK, "Done disassembling packet");
d7atp_process_received_packet(packet);
return;
cleanup:
DPRINT(LOG_STACK_FWK, "Skipping packet");
packet_queue_free_packet(packet);
return;
}
int main(void) {
// Initialize the OSS-7 Stack
system_init();
// Currently we address the Transport Layer for RX, this should go to an upper layer once it is working.
trans_init();
trans_set_query_rx_callback(&rx_callback);
trans_set_tx_callback(&tx_callback);
// The initial Tca for the CSMA-CA in
trans_set_initial_t_ca(200);
start_channel_scan = true;
log_print_string("gateway started");
// Log the device id
log_print_data(device_id, 8);
// configure blinking led event
dim_led_event.next_event = 50;
dim_led_event.f = &dim_led;
system_watchdog_init(WDTSSEL0, 0x03);
system_watchdog_timer_start();
blink_led();
while(1)
{
if (start_channel_scan)
{
start_rx();
}
// Don't know why but system reboots when LPM > 1 since ACLK is uses for UART
system_lowpower_mode(0,1);
}
}
error_t hw_radio_send_packet(hw_radio_packet_t* packet, tx_packet_callback_t tx_cb)
{
// TODO error handling EINVAL, ESIZE, EOFF
if(current_state == HW_RADIO_STATE_TX)
return EBUSY;
assert(packet->length < 63); // long packets not yet supported
tx_packet_callback = tx_cb;
if(current_state == HW_RADIO_STATE_RX)
{
pending_rx_cfg.channel_id = current_channel_id;
pending_rx_cfg.syncword_class = current_syncword_class;
should_rx_after_tx_completed = true;
}
current_state = HW_RADIO_STATE_TX;
current_packet = packet;
cc1101_interface_strobe(RF_SIDLE);
cc1101_interface_strobe(RF_SFTX);
#ifdef FRAMEWORK_LOG_ENABLED // TODO more granular
log_print_stack_string(LOG_STACK_PHY, "Data to TX Fifo:");
log_print_data(packet->data, packet->length + 1);
#endif
configure_channel((channel_id_t*)&(current_packet->tx_meta.tx_cfg.channel_id));
configure_eirp(current_packet->tx_meta.tx_cfg.eirp);
configure_syncword_class(current_packet->tx_meta.tx_cfg.syncword_class);
cc1101_interface_write_burst_reg(TXFIFO, packet->data, packet->length + 1);
cc1101_interface_set_interrupts_enabled(true);
cc1101_interface_strobe(RF_STX);
return SUCCESS;
}
