impovements to drive functions for real robot