Clean up Cartesian spherical blends
Some additional plotting tests
Encapsulate structs for joint trajectories
Some transform twiddling
JNI bindings for workspace trajectory