first draft for cob_twist_controller