Added lv in debug prints, added closed loop/open loop switch for the ik
added rt publishers for joints
Added roscpp dep on dmp_controller, added node handle and write read functions
Added roscpp dep on dmp_controller, added node handle and write read functions
Added a basic parsing