#include <RobotAPI/libraries/RobotStatechartHelpers/ObstacleAvoidingPlatformUnitHelper.h>
#include <SimoxUtility/math.h>
#include <VirtualRobot/Nodes/RobotNode.h>