trajectory generator with constant acceleration added
Merge remote-tracking branch 'github/develop' into develop