Adding some tests.

Fixing error that was caused by a rounding issue resulting in a doubled end point when creating a cspace path.
Fixing several typos.


git-svn-id: http://svn.code.sf.net/p/simox/code/trunk@222 042f3d55-54a8-47e9-b7fb-15903f145c44