Added extra logging and some fixes to make it work on the real robot.
3 files changed