Added robot model interface class

Addresses issues #8 and #9.
Good catch...it should be a vector of vectors (like in the `trajectory_pt` methods)