ForeverYoung_M的博客

原创 计算非等间隔离散曲线的曲率

计算非等间隔离散曲线的曲率简介参考：[link](https://zhuanlan.zhihu.com/p/72083902/).代码结果简介由于需要计算车辆行驶轨迹的曲率，但由于车辆的车速不同，每次采集的轨迹点非等间隔，这里借鉴了诸多大神的经验，主要参考了下面的思路才得到最后结果。参考：link.代码function Curvature = ThreePoint2Curvature(x,y,n) x = reshape(x,3,1); y = reshape(y,3,1);