Implement end-effector constraint verification + tests

Implements end-effector constraint that allows to restrict the end-effector to certain velocities and/or poses.

Also fixes #17 (closed).