Merge pull request #2 from manaspaldhe12/master

Hubo-read-trajectory
Merge pull request #3 from manaspaldhe12/master

Interpolation
Merge pull request #4 from manaspaldhe12/master

Corrected a couple of compile errors
Whole Body read trajectory