control barrier function for IK

Investigate and reproduce paper results for IK with collision avoidance using control barrier function.

TODO. add video recordings for this.