back.cpp

/*
  後進のサンプル
  Satofumi KAMIMURA
  $Id$
*/

#if !MONITOR
#include <runCtrl.h>
#else
#include <mRunCtrl.h>
#endif
#include <typePrint.h>
#include <stdio.h>
#include <stdlib.h>

using namespace VXV;


int main(int argc, char *argv[]) {
  try {
#if !MONITOR
    RunCtrl run;
#else
    mRunCtrl run;
    vmonitor::show();
#endif
    if (run.connect(argc, argv) < 0) {
      printf("RunCtrl::connect: %s\n", run.what());
      exit(1);
    }

    run.setStraightRefVel(-300);
    run.followLine(Position(0, 0, deg(0)));
    VXV::Delay(3000);

    run.stop();
    VXV::Delay(1000);
    
  } catch (std::exception& e) {
    printf("exception: %s\n", e.what());
  }
  return 0;
}