#include <iostream>
#include <boost/uuid/uuid_io.hpp>
#include <boost/optional.hpp>
#include "ble/Bluetooth.h"
#include "SoilMoisture.h"

using namespace std;
using namespace trygvis::bluetooth;
using namespace trygvis::soil_moisture;

bool loop = true;

void withConnection(BluetoothGatt &gatt) {
    SoilMoisture soilMoisture = SoilMoisture::create(gatt);

    int sensorCount = soilMoisture.getSensorCount();

    while (loop) {
        for (uint8_t i = 0; i < sensorCount; i++) {
            uint16_t value = soilMoisture.getValue(i);

            cout << "sensor=" << to_string(i) << ", value=" << (int) value << endl;
        }

        sleep(1);
    }
}

int main(int argc, char *argv[]) {
    if (argc != 2) {
        cerr << "usage: " << argv[0] << " [mac]" << endl;
        return EXIT_FAILURE;
    }

    __attribute__((unused))
    BluetoothSystem bluetoothSystem;

    try {
        Mac mac = Mac::parseMac(argv[1]);

        auto &adapter = getAdapter(0);

        auto &device = adapter.getDevice(mac);

        while (loop) {
            cout << "Connecting to device: " << device.getMac().str() << endl;

            auto &gatt = device.connectGatt();
            try {
                withConnection(gatt);
            } catch (runtime_error &e) {
                cout << "exception: " << e.what() << endl;
            }
            gatt.disconnect();
        }

        return EXIT_SUCCESS;
    } catch (std::runtime_error ex) {
        cout << "std::runtime_error: " << ex.what() << endl;
        return EXIT_FAILURE;
    } catch (std::exception ex) {
        cout << "std::exception: " << ex.what() << endl;
        return EXIT_FAILURE;
    }
}