#include "MicroBit.h"

#if CONFIG_ENABLED(MICROBIT_DBG)
Serial pc(USBTX, USBRX);
#endif

MicroBit        uBit;
InterruptIn     resetButton(MICROBIT_PIN_BUTTON_RESET);

void
reset()
{
    NVIC_SystemReset();
}


int main()
{    
    // Bring up soft reset button.
    resetButton.mode(PullUp);
    resetButton.fall(reset);
    
#if CONFIG_ENABLED(MICROBIT_DBG)
    pc.baud(115200);

    // For diagnostics. Gives time to open the console window. :-) 
    for (int i=3; i>0; i--)
    {
        pc.printf("=== SUPERMAIN: Starting in %d ===\n", i);
        wait(1.0);
    }
#endif    

    // Bring up our nested heap allocator.
    microbit_heap_init();

    // Bring up fiber scheduler
    scheduler_init();
    
    // Bring up random number generator, BLE, display and system timers.    
    uBit.init();

    // Provide time for all threaded initialisers to complete.
    uBit.sleep(100);

#if CONFIG_ENABLED(MICROBIT_BLE_BLUEZONE)
    // Test if we need to enter BLE pairing mode...
    int i=0;
    while (uBit.buttonA.isPressed() && uBit.buttonB.isPressed() && i<10)
    {
        uBit.sleep(100);
        i++;
        
        if (i == 10)
        {
            // OK - we need to enter BLUE ZONE mode.
            // Test to see if BLE and the necessary services have been brought up already.
            // If not, start them.
            if (!uBit.ble)
            {
                uBit.ble = new BLEDevice();
                uBit.ble->init();
                uBit.ble->onDisconnection(bleDisconnectionCallback);
            }

            if (!uBit.ble_firmware_update_service)
            {
                uBit.ble_firmware_update_service = new MicroBitDFUService(*uBit.ble);
                uBit.ble_firmware_update_service->getName(MICROBIT_BLE_DEVICE_NAME+14);
            }

            // Ensure we're advertising.
            uBit.ble->accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
            uBit.ble->accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)MICROBIT_BLE_DEVICE_NAME, strlen(MICROBIT_BLE_DEVICE_NAME)+1);
            uBit.ble->setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
            uBit.ble->setAdvertisingInterval(Gap::MSEC_TO_ADVERTISEMENT_DURATION_UNITS(1000));
            uBit.ble->startAdvertising();  

            // enter BLUE ZONE mode.
            uBit.ble_firmware_update_service->pair();
        }
    }
#endif
       
    app_main();

    // If app_main exits, there may still be other fibers running, registered event handlers etc.
    // Simply release this fiber, which will mean we enter the scheduler. Worse case, we then
    // sit in the idle task forever, in a power efficient sleep.
    release_fiber();
   
    // We should never get here, but just in case.
    while(1);
}