Made stuff more robust. Fixed WST joint. Increased FPS. Almost ready for demo.
Improved trajectory files. Integrated NKY values. (And scaled by 1/2 because that looked right.) Formatted nicely with spaces now.
The files should still compatible with hubo-read-trajectory because that uses sscanf - spaces vs tabs shouldn't matter.