Some clarifying comments and a bug-fix.
Added extraction of tool-pose to beasty state-callback.
Bug-fix: Beasty expects hom. transforms in column-major form, CONTRARY to documentation.
Bug-fix: Beasty's TCP is not at arm_7_link. Adapted default tool-offset accordingly.
Implemented Cartesian Impedance motion mode.