首先要确定反馈量和控制量，这里反馈量用的是车和最近路径点的横向误差，控制量用的是前轮转角。 算法如下： 1. 根据当前定位结果找到路径最邻近点。 2. 计算该点与定位结果横向误差。 3. 以该误差作为反馈测量值通过pid生成控制量即前轮转角。 4. 将前轮转角转化为航向角，带入运动模型 ...

这一篇可以说是之前拉格朗日方法的后续，拉格朗日方法能够计算等式约束的二次规划。 这里的路径跟踪法能够计算不等式约束的二次规划或线性规划。至于等式和不等式混合约束的线性规划我以后会用单纯形方法来求解。 推导方法依然如《最优化理论与算法（第2版）》书上所述： 这里代码如下（代码中 ...

图的相关算法也算是自己的一个软肋了，当年没选修图论也是一大遗憾。 图像处理中，也有使用图论算法作为基础的相关算法，比如图割，这个算法就需要求最大流、最小割。所以熟悉一下图论算法对于图像处理还是很有帮助的。 Dijkstra和Bellman-Ford类似，都是解决单源最短路径问题 ...

目标内边界的像素全都在目标里面，目标外边界的像素全都不在目标上，是包围着目标的。 二值图像内外边界的计算都是有两种方法的，所以一共是4种算法，不过实际用到跟踪的只有一个而已。 首先是内边界跟踪： 第一种方法不是跟踪方法。步骤是先对原图像腐蚀，然后用原图像减去腐蚀后的图像就得到边界 ...

BFGS和DFP都是拟牛顿法，和高斯牛顿法不同的地方是不用直接求黑塞矩阵了，而BFGS又比DFP算法有更好的数值稳定性。 算法步骤如下： 1. 给一个待求参数的初始值x(1)。 2. 给定H(1 ...

　　PSNR，峰值信噪比，通常用来评价一幅图像压缩后和原图像相比质量的好坏，当然，压缩后图像一定会比原图像质量差的，所以就用这样一个评价指标来规定标准了。PSNR越高，压缩后失真越小。这里主要定义了两 ...

DBSCAN全称Density-Based Spatial Clustering of Applications with Noise，是一种密度聚类算法。 和Kmeans相比，不需要事先知道数据的 ...

之前用simulink仿过一次PID算法，这次用代码实现一遍。 该算法工程性很强，一般需要结合实际调整一个合适的参数用于控制。 matlab代码如下： 结果如下： 当然就本例而言，0,1,0是最优参数。。。 ...