Optimal velocity profile planning considering velocity, acceleration and jerk constraints