/* 
 * File:   main.cpp
 * Author: fede.tft
 *
 * Created on September 10, 2009, 10:50 AM
 */

#include <iostream>
#include <boost/algorithm/string.hpp>
#include <boost/algorithm/string/split.hpp>
#include "TimeoutSerial.h"
#include "XModem.h"

using namespace std;
using namespace boost;

typedef vector< string > split_vector_type;  

bool dataHandler(unsigned long blockNo, char* buffer, int size)
{
    cout << "Block No. = " << blockNo << endl;
    for (int i=0 ; i<size ; i++) {
        cout << char(buffer[i]) << " ";
    }
    cout << endl;

    return true;
}

int main(int argc, char* argv[])
{
    string line;
    float temperature = NAN;
    float humidity= NAN;
    float pressure = NAN;

    try {
 
        TimeoutSerial serial("/dev/ttyUSB0",115200);
        serial.setTimeout(posix_time::seconds(10));
        serial.setDTR(false);
        serial.setRTS(false);
        sleep(5);
        //Text test
        
        serial.writeString("?\r\n");


        line = serial.readStringUntil("\n");
        trim(line);
        cout << line << endl;

        serial.writeString("measure\r\n");
        
        for (;;) {
            line = serial.readStringUntil("\n");
            trim(line);
            if (line == "") continue;
            // cout << line << endl;
            
            split_vector_type SplitVec; // #2: Search for tokens
            split( SplitVec, line, is_any_of(" "), token_compress_on ); // SplitVec == { "hello abc","ABC","aBc goodbye" }
            
            for (vector<string>::iterator t=SplitVec.begin(); t!=SplitVec.end(); ++t) {
                split_vector_type kv;
                split(kv, *t, is_any_of("="), token_compress_on);
                // cout << "kv[0]=" << kv[0] << endl;
                if (kv[0] == "temperature") temperature = stof(kv[1]);
                if (kv[0] == "humidity") humidity = stof(kv[1]);
                if (kv[0] == "pressure") pressure = stof(kv[1]);
            }

            if (pressure > 0.0) break;   
        }

        cout << "teplota = " << temperature << endl;
        cout << "vlhkost = " << humidity << endl;
        cout << "tlak = " << pressure << endl;

        XModem modem(&serial,dataHandler);

        serial.writeString("capture\r\n");
        sleep(1);
        line = serial.readStringUntil("\r\n");
        cout << line << endl;
        line = serial.readStringUntil("\r\n");
        cout << line << endl;
        line = serial.readStringUntil("\r\n");
        cout << line << endl;
        line = serial.readStringUntil("\r\n");
        cout << line << endl;
      //  line = serial.readStringUntil("\r\n");
      //  cout << line << endl;
    
        serial.writeString("rb\r\n");
        sleep(1);
        serial.readChar(1);
        serial.readChar(1);    
        modem.receive();
        sleep(1);
        serial.writeString("free\r\n");

        serial.close();
  
    } catch(boost::system::system_error& e)
    {
        cout<<"Error: "<<e.what()<<endl;
        return 1;
    }
}