Add the current TEO_trajectory_generation project to github