文章目录
-
- 写在前面
- 自适应辛普森公式求积分
- matlab简单测试代码如下
- 求样条曲线长度
- 参考
写在前面
挖个坑~
在样条学习过程中遇到了积分求解样条长度的问题,一般曲线长度的求解可以采用对速度积分的方式,但如果直接由速度解析表达式计算路径长度非常困难,尤其当表达式复杂的时候,对于计算机编程而言非常不友好。为此,可通过数值积分的方式对表达式进行近似积分,常见方法有复合梯形积分、复合辛普森积分。下面尝试采用自适应辛普森公式,先简单用matlab测试一下~
自适应辛普森公式求积分
matlab简单测试代码如下
% 自适应辛普森求积分
% https://blog.csdn.net/frosero/article/details/45799135
function y = adaptive_simpson(a, b, eps)
y = main_adaptive_simpson(a, b, eps, simpson(a, b));
end
function y = main_adaptive_simpson(a, b, eps, A)
c = a + (b - a) / 2.0; % A为区间[a,b]的三点辛普森值
L = simpson(a,c);
R = simpson(c,b);
if (abs(L + R - A) <= 15 * eps)
y = L + R + (L + R - A) / 15.0;
else
y = main_adaptive_simpson(a,c,eps/2.0,L) + main_adaptive_simpson(c,b,eps/2.0,R);
end
end
% 自定义函数
function f = func(x)
f = x * x * x + x;
end
function y = simpson(a, b)
c = a + (b - a) / 2.0;
y = (func(a) + 4 * func(c) + func(b)) * (b - a) / 6.0;
end
求样条曲线长度
核心函数如下:
...上接B样条基本曲线程序
% 求B样条曲线长度
% 曲线求导
% 导数曲线对应的节点矢量可通过去掉原曲线节点矢量的首末端点获得
u_new = u(2: end-1);
Q = zeros(n+1, 3);
line = zeros(1, 3);
% 求导数曲线对应的控制点
for i = 1: n+1
Q(i, :) = k * (P(i+1, :)-P(i, :)) / (u(i+k+1) - u(i+1));
end
for j = 1: n-1
La = u_new(j+2); % u_new比之前u少两个
Lb = u_new(j+3);
line(j) = adaptive_simpson(La, Lb, 1e-5, Q, u_new, k, j);
end
length_arc_B = line(1) + line(2) + line(3);
...
按照上述辛普森积分程序,适当进行修改即可
参考
[学习笔记]自适应辛普森(Simpson)积分
自适应辛普森公式求积分
赖永林,林茂松,梁艳阳.基于三次非均匀B样条曲线的机器人轨迹规划算法研究[J].科学技术与工程,2013,13(35):10511-10517.
评论(0)
您还未登录,请登录后发表或查看评论