added trajectory profile generation. todo: jerk limitation