ROS interface for KOMO framework