matlab练习程序（光流法）
HSoptflow.m main.m 老外写的函数，拿来研究研究。 ...
原文：matlab练习程序（人工势场法）
该方法也是一种路径规划算法，不过障碍物过多的时候建立势场可能比较耗时，而且容易陷入局部最优。 算法流程如下： . 对于栅格场景中每一个像素分别计算到终点的距离，距离越大，则对该像素赋值越大，结束得到引力场。 . 对于栅格场景中每一个像素分别计算到所有障碍物的距离，距离越大，则对该像素赋值越小，结束得到斥力场。 . 引力场和斥力场相加得到总人工势场。 . 得到人工势场后，从起始位置用梯度下降或者邻域 ...
2020-02-06 21:14 1 6512 推荐指数：
相关推荐
matlab练习程序（常微分方程向量场）
通过向量场能很直观的看到微分方程所有解的变化规律。 这里随便设了个方程：dx/dt = sin(t)*cos(x)+sin(t)。 由于方程本身就代表了x在t处的斜率，所以： vt = cos(atan(f)); vx = sin(atan(f)); matlab代码 ...
人工势场法路径规划简述（无人机，机器人，路径规划，寻路算法）
概念简述： 人工势场法路径规划基本思想是将机器人在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动机器人产生“引力”，障碍物对移动机器人产生“斥力”，最后通过求合力来控制移动机器人的运动。应用势场法规划出来的路径一般是比较平滑并且安全，但是这种方法存在局部最优点问题。 这算法 ...
matlab练习程序（寻找凸包，Graham扫描法）
我不太清楚这个凸包在图像处理中到底会怎样的运用，因为这个好像更多的是计算几何或是图形学里面的东西。不过作为一个算法，我感觉还是有必要研究一下的。我主要的参考资料是《算法导论》的33.3和这个博客。 ...
matlab练习程序（高斯牛顿法最优化）
计算步骤如下： 图片来自《视觉slam十四讲》6.2.2节。 下面使用书中的练习y=exp(a*x^2+b*x+c)+w这个模型验证一下，其中w为噪声，a、b、c为待解算系数。 代码如下： 迭代结果，其中散点为带噪声数据，红线为原始模型，绿线为解算模型 ...
matlab练习程序（点云表面法向量）
思路还是很容易想到的： 1.首先使用KD树寻找当前点邻域的N个点，这里取了10个，直接调用了vlfeat。 2.用最小二乘估计当前邻域点组成的平面，得到法向量。 3.根据当前邻域点平均值确定邻域质心，通常质心会在弯曲表面的内部，反方向即为法线方向。 vlfeat在这里下载，配置参考 ...
matlab练习程序（龙格库塔法）
非刚性常微分方程的数值解法通常会用四阶龙格库塔算法，其matlab函数对应ode45。 对于dy/dx = f(x,y)，y(0)=y0。 其四阶龙格库塔公式如下： 对于通常计算，四阶已经够用，四阶以上函数f(x,y)计算工作量大大增加而精度提高较慢。 下面以龙格库塔法解洛伦兹方程为例 ...
matlab练习程序（点集配准的SVD法）
上一篇博客中我们使用了四元数法计算点集配准。 本篇我们使用SVD计算点集配准。 下面是《视觉slam十四讲》中的计算方法： 计算步骤如下： 我们看到，只要求出了两组点之间的旋转，平移是非常容易得到的，所以我们重点关注R的计算。展开关于R的误差项，得： 注意到第一项和R无关，第二项 ...