#include "Particle.h"

SYSTEM_MODE(SEMI_AUTOMATIC);
SYSTEM_THREAD(ENABLED);

SerialLogHandler logHandler(LOG_LEVEL_ALL);

int advert_count;
void scan_result_cb(const BleScanResult *result, void *context) {
    advert_count++;
    // Log.info("\tgot advert");
}

void scan_thread_f() {
    unsigned int short_scan_count = 0;
    while (true) {
        unsigned int t0, t1;
        advert_count = 0;
        t0 = millis();
        BLE.scan(scan_result_cb, nullptr);
        t1 = millis();
        if (t1 - t0 < 50) {
            short_scan_count++;
        } else {
            short_scan_count = 0;
            if (t1 - t0 > 500) {
                Log.info("\tscan too long: %dms", t1 - t0);
            }
        }
        if (advert_count) {
            Log.info("BLE scan got %d adverts (duration %ums)", advert_count, t1 - t0);
        }
        if (short_scan_count && !(short_scan_count % 1000)) {
            Log.info("BLE scan too short last %d scans (ex. %dms)", short_scan_count, t1 - t0);
        }
        delay(1);
    }
}

void setup() {
    while (!Serial.isConnected()) {
        delay(100);
    }

    BLE.on();
    // quick scans should see the issue more quickly
    BLE.setScanTimeout(10);

    static Thread *thread = new Thread("sensor_ble_scan", scan_thread_f, OS_THREAD_PRIORITY_DEFAULT);
}