Finished off tests for robot-maths and got rid of the 'TODO' docs