Added aux functions to convert between KDL::Twist and KDL::JntArray of fixed size.
Added a special weighted solver for controlling in Cartesian Twist space.
Some bug-fixes for CartesianConstraintController.
Another bug-fix.
Yet another bug-fix.
Added ConstraintController for pure Cartesian Tasks, i.e. flying tools, and corresponding unit-tests.