enum _state

{

    SYSTEM_IDLE = 0, // awaiting RTC interrupt for wakeup TODO wake up before scheduled time to get fix?

    SYSTEM_GPSACQ, // RTC interrupted

    SYSTEM_WSPRTX, // Wait for timeslot and actually transmit the message

};

static void __calc_gridloc(char *dst, double lat, double lon);

static void ledpulse(void);

uint32_t statled_ontime = 0;

int main(void)

{

    HAL_Init();

    HAL_Delay(1000); // startup delay before infinisleep

    sysclk_init();

    gpio_init();

    rtc_init();

    adc_init();

    wspr_init();

    uint32_t led_timer = HAL_GetTick();

    led_blink(4);

    uint16_t blink_rate = BLINK_FAST;

//    uint8_t state = SYSTEM_GPSACQ;

//DEBUG:

    uint8_t state = SYSTEM_IDLE;

    uint32_t gps_polltimer = 0;

    uint32_t fix_acq_starttime = 0;

    uint32_t nextwspr_time = 0;

    uint8_t nextwspr_time_valid = 0;

    uint32_t last_wspr_tx_time = 0;

    uint8_t packet_type = 0;

    // Transmit pilot tone to test TX on bootup

    HAL_Delay(1000);

    wspr_pilot_tone();

    adc_stop();

    HAL_Delay(1000);

    while (1)

    {

    	// TODO: Disable GPIO port clocking when not needed!

    	// Every 10 minutes, wake up and try to wspr

    	if(state == SYSTEM_IDLE && (HAL_GetTick() - last_wspr_tx_time > 60000 * 10))

    	{

    		state = SYSTEM_GPSACQ;

    	}

        // Update fix status every 2 seconds, only if the GPS is powered on

        if(HAL_GetTick() - gps_polltimer > 2000)

        {

            if(gps_ison())

            {

            	gps_update_data();

            	// If odd minute

            	if(gps_getdata()->minute % 2)

            	{

            		// Wait until even minute plus one second, coming soon

            		nextwspr_time = HAL_GetTick() + (60000 - (gps_getdata()->second * 1000));

                    nextwspr_time_valid = 1;

            	}

            	// If even minute

            	else

            	{

            		// Wait until odd minute, one minute and some change away

            		nextwspr_time = HAL_GetTick() + 60000 + (60000 - (gps_getdata()->second * 1000));

                    nextwspr_time_valid = 1;

            	}

            }

            gps_polltimer = HAL_GetTick();

        }

        switch(state)

        {

            // Idling: sleep and wait for RTC timeslot trigger

            case SYSTEM_IDLE:

            {

                blink_rate = BLINK_SLOW;

                // Actually sleep for real: disable systick and sleep until RTC interrupt

//                HAL_SuspendTick();

                // Enter sleep mode: wait for interrupt

                //HAL_PWR_EnterSLEEPMode(0, PWR_SLEEPENTRY_WFI);

        		HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI);

                // This is hopefully the only timer that needs to stay alive in idle mode

 //               last_wspr_tx_time += 0; // move this timer forward based on sleep length

 //               HAL_ResumeTick();

                // TODO: Eventually use GPS time to calibrate the RTC maybe

            } break;

            // Attempt to acquire GPS fix

            case SYSTEM_GPSACQ:

            {

                blink_rate = BLINK_FAST;

                HAL_PWR_EnterSLEEPMode(0, PWR_SLEEPENTRY_WFI);

                HAL_PWR_EnterSLEEPMode(0, PWR_SLEEPENTRY_WFI);

                HAL_PWR_EnterSLEEPMode(0, PWR_SLEEPENTRY_WFI);

                HAL_PWR_EnterSLEEPMode(0, PWR_SLEEPENTRY_WFI);

                if(!gps_ison())

                {

                	fix_acq_starttime = HAL_GetTick();

                    gps_poweron(); // power on and initialize GPS module

                }

                // TODO: Move GPS processing into here from above!

                // If 3d fix with a decent enough precision

                if( ((gps_getdata()->fixtype == 2) || (gps_getdata()->fixtype == 3)) && gps_getdata()->pdop < 10 && nextwspr_time_valid == 1)

                {

                    // Disable GPS module

                    gps_poweroff();

                    // TODO: Set RTC from GPS time

                    // TODO: Set RTC for countdown to next transmission timeslot!

                    // TODO: Set wspr countdown timer for this transmission!

                    fix_acq_starttime = 0;

                    state = SYSTEM_WSPRTX;

                    adc_start();

                }

                // If no decent fix in 3 minutes

                else if(HAL_GetTick() - fix_acq_starttime > 60000 * 3)

                {