#include "Behaviors/Demos/Navigation/PilotDemo.h"

$nodeclass ToFirstCylinder : PilotDemo {

    $setupmachine{
         startdemo: TurnCW(0.2) =C=> GoForward(1200) =C=> PostMachineCompletion
    }

    $nodeclass TurnCCW(float x) : PilotNode(PilotTypes::walk) : doStart {
         pilotreq.da = x;
    }

    $nodeclass TurnCW(float x) : PilotNode(PilotTypes::walk) : doStart {
         pilotreq.da = -x;
    }

    $nodeclass GoForward(float x) : PilotNode(PilotTypes::walk) : doStart {
        pilotreq.dx = x; // forward half a meter
    }

}

REGISTER_BEHAVIOR(ToFirstCylinder);