#include <atmel_start.h>

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

#include "radio_hw_instance.hpp"
#include "skullc_samd21_hal.hpp"
#include "app_transparent_client.hpp"

namespace Hal = Peripherals::Hal::Samd;

namespace
{

Utility::StaticPointer<App::TransparentClient> m_app;

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

  __asm__("BKPT");

  while (true);
}

}

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

  Utility::Assert::setHandler(m_faultHandler);
  Hal::StaticHal::initialize();

  gpio_set_pin_level(OUT_LED_TX, false);

  SKULLC_LOG_DEBUG("Begin.");

  const App::RadioSettings settings;

  m_app.setup(settings);
  radio::HwInstance* radio_hw = radio::HwInstance::instance();

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

    gpio_toggle_pin_level(OUT_LED_TX);

    int16_t radio_status = radio_hw->register_read(radio::Registers::TRX_STATUS);
    radio_status &= 0x1F;

    SKULLC_LOG_INFO("Status: %d", radio_status);
    SKULLC_LOG_INFO("Millis: %u", Hal::StaticHal::getMillis());

    delay_ms(1000);
	}
}