Trapezoidal velocity profile trajectory in robotics