在matlab中用bvp4c求解器进行轨迹规划