bang_bang_controller now works as expected