Separate FriExampleAbstract
Add getRobotState
Add getJointState
Add getCartesianWrench
Add getJacobian