Dev/programming by demonstration
Adds and extends config files for controllers:
- NJointTaskspaceMixedImpedanceVelocityController/default_a7_with_hands.json: extend by
safeRotAngleDegreeToGoal - NJointTaskspaceVelocityController/default_a7_sim.json: add
Improve logging in failure case:
- Clearly state which coordinate is which one in case of quaternions