关于算法实现1——RRT算法原理及matlab编写

  首先我们得明白算法的原理，然后写出步骤。根据步骤可以写出主函数包括每一步的输入输出，怎么表示（基本的伪代码表示，当然如果可以也可以写成汉字形式的），最后一步一步写出代码，调试工作是必须的(建议：子函数尽量分开写，功能分明，便于调试)。好了，差不多就这样，开始做吧^-^ 1建立地图，设置起始点，目标点，（障碍带） 2初始化参数： 顶点vertices=起始点q_start; 边edges=空集e

>>阅读原文<<