|
|
#include "CartesianImpedanceController.h"#include <algorithm>#include <SimoxUtility/math/compare/is_equal.h>#include <SimoxUtility/math/convert/mat4f_to_pos.h>#include <SimoxUtility/math/convert/mat4f_to_quat.h>#include <VirtualRobot/IK/DifferentialIK.h>#include <VirtualRobot/IK/IKSolver.h>#include <VirtualRobot/MathTools.h>#include <VirtualRobot/Nodes/RobotNode.h>#include <VirtualRobot/Robot.h>#include <VirtualRobot/RobotNodeSet.h>#include <RobotAPI/components/units/RobotUnit/ControlTargets/ControlTarget1DoFActuator.h>#include <RobotAPI/components/units/RobotUnit/SensorValues/SensorValue1DoFActuator.h>