Modified unicycle controller impl