Modified some scripts for the real robot