#include "System.h"
#include "MethaneSensor.h"
#include "PolledDriverTask.h"
#include "Syslog.h"
#include "SerialParameters.h"

// Data acquisition period
#define AcqPeriod 2000

int main( int argc, char **argv )
{
  // Set task priority
  if (System::setTaskPriority(NonCriticalDriverPriority) == -1)
    return 1;

  Boolean verbose = False;
  for (int i = 1; i < argc; i++) {
    if (!strcmp(argv[i], "-v")) 
      verbose = True;
  }

  SerialDevice *device = 0;
  MethaneSensor *driver = 0;
  PolledDriverTask *driverTask = 0;

  try {
    SerialParameters params(&argc, argv);
    device = new SerialDevice(&params);
    device->commsDebugMode(SerialDevice::DebugOff);
    driver = new MethaneSensor(device, verbose);
    driverTask = new PolledDriverTask("methaneDriver", driver, AcqPeriod);
    driverTask->run();
  }
  catch (Exception e) {
    Syslog::write("%s - caught Exception: %s\n", argv[0], e.msg);
  }
  catch (...) {
    Syslog::write("%s - caught unknown exception\n", argv[0]);
  }

  delete driverTask;
  delete driver;
  delete device;

  return 0;

}