Changed some console/typos

- MoveTo takes (x,y,theta) not (x,y,z)
- Use codes for result_ok and result_failed when making calls to NAO
- added cleaner printing for console