Implement and test JointCommandInterfaces

closed #15