极小值原理，给出已知初始位置和最终位置，来求解初始到末端做优化路径。(with initial position and a finally position to get a most great way to get the finally position.)