机器人轨迹规划：求解样条曲线长度——自适应辛普森公式求积分