自动驾驶AVM环视算法原理–迭代方式计算坐标

主要是使用迭代的当时计算

f(x+△x)=f(x)+△x*f‘’(x)

得出

(f(x+△x)-f(x))/f‘’(x)=△x

得出

(f(cur)-f(pre))/f'(pre)=cur-pre

得出

cur=pre+(f(cur)-f(pre))/f‘(pre)

每次计算完成后会更新cur之后将cur幅值给pre继续迭代，知道cur和pre的插值达到阈值后停止迭代或者是计算次数达到阈值后停止，就可以计算出坐标点cur的值。

其中f(x)函数如下所示：

f(p)=a0+a2*p^2+a3*p^3+a4*p^4;

p=sqrt(x^2+y^2)

将f(p)带入到上述的计算公式中就可以计算出每次迭代的结果。