Take into account robot state for drive controls
Take into account robot state for drive controls