Merge pull request #5 from manaspaldhe12/master

Tested Pause and Play, console input
corrected pause?
compliance in trajectory follow