#include <atmel_start.h>

#include <utility_logging.hpp>
#include <utility_assert.hpp>

#include "radio_hw_instance.hpp"
#include "app_logging.hpp"
#include "skullc_samd21_hal.hpp"

namespace Hal = Peripherals::Hal::Samd;

namespace
{

[[noreturn]] void m_faultHandler(const char* file, const int line)
{
  SKULLC_LOG_FATAL("Fault: %s:%d", file, line);

  __asm__("BKPT");

  while (true);
}

}

int main()
{
	/* Initializes MCU, drivers and middleware */
	atmel_start_init();

  Utility::Assert::setHandler(m_faultHandler);

  gpio_set_pin_level(OUT_LED_TX, false);

  App::Logging::setup();

  radio::HwInstance radio_hw;

	/* Replace with your application code */
	while (true)
  {
    gpio_toggle_pin_level(OUT_LED_RX);

    const int16_t radio_num = radio_hw.register_read(0x1C);

    SKULLC_LOG_INFO("Reg 0x1C: %d", radio_num);

    gpio_toggle_pin_level(OUT_LED_TX);

    delay_ms(1000);
	}
}