Fixes for the real robot