generate initial cartesian trajectory
handle continuous joint