revision of cob_twist_controller