#include "MoveJoints.h"
#include <ArmarXCore/core/time/TimeUtil.h>
#include <RobotAPI/interface/units/KinematicUnitInterface.h>
#include "MotionControlGroupStatechartContext.h"
#include <VirtualRobot/RobotConfig.h>