在角度轨迹中寻找角度最大的值，即为第一个波峰或者第一个波谷，笛卡尔坐标系中，通过atan2获取的角度最大并不一定是在拐弯，直线上的轻微抖动都会形成一个类似拐弯的角度，比如行驶的角度为 【160°，162°，167°，170°，168°，166°】，其实这是一条只想，波峰出现在170°的位置，//窗口滤波寻找峰值峰谷charfindPeaksAndTroughs(intp,int*out_…

手上有一批GPS轨迹，已经求得两点之间的角度，但由于GPS轨迹没有经过滤波，得到的GPS轨迹两点之间的角度浮动太大，使用经典的低通滤波可以将频繁出现的高频信号过滤掉，上一数据所占比重为0。8本节信息比重为0.2效果不错。如下图