building class
moved trajectory generator class to jacgit
finished trajectory generator
searching bug in pinv