#include "Behaviors/StateMachine.h"

$nodeclass SceneBuilder : VisualRoutinesStateNode {

	$nodeclass FindObjects : MapBuilderNode(MapBuilderRequest::localMap) : doStart {
		mapreq.clearLocal = false;
		mapreq.addObjectColor(ellipseDataType, "red");
		mapreq.addObjectColor(ellipseDataType, "green");
		mapreq.addObjectColor(ellipseDataType, "blue");
		mapreq.addObjectColor(lineDataType, "red");
		mapreq.addOccluderColor(lineDataType, "red");
	}

	$nodeclass MyHeadPointerNode : HeadPointerNode : preStart {
		HeadPointerNode::preStart();
		getMC()->setMaxSpeed(0, 0.4);
		getMC()->setMaxSpeed(1, 0.4);
	}

	$setupmachine {
		MyHeadPointerNode[getMC()->lookAtPoint(600, 800, 0);]
		=C=> FindObjects
		=C=> MyHeadPointerNode[getMC()->lookAtPoint(600, 300, 0);]
		=C=> FindObjects
		=C=> MyHeadPointerNode[getMC()->lookAtPoint(600, -200, 0);]
		=C=> FindObjects
		=C=> MyHeadPointerNode[getMC()->lookAtPoint(600, -700, 0);]
		=C=> FindObjects
		=C=> SpeechNode("done")  
	}
}
REGISTER_BEHAVIOR(SceneBuilder);