All 3 test robots working now

Also fixed toString for paths.