#include "Behaviors/StateMachine.h"

$nodeclass GripperPosition : StateNode {

		$nodeclass GetPosition : StateNode : doStart {
			cout << "Gripper position: " << kine->linkToBase(GripperFrameOffset).translation() << endl;
		}
	
		$setupmachine {
			GetPosition
		}
	}

REGISTER_BEHAVIOR(GripperPosition);