Time optimal path planning considering acceleration limits