uthman
QQ:3749615
级别: 家园常客
精华主题: 1 篇
发帖数量: 442 个
工控威望: 800 点
下载积分: 2718 分
在线时间: 752(小时)
注册时间: 2007-10-25
最后登录: 2024-04-30
查看uthman的 主题 / 回贴
楼主  发表于: 2024-01-31 13:26
如需转载,请注明出处。
七次多项式推导
f(x)=A_7 x⁷ + A_6 x⁶ + A_5 x⁵ + A_4 x⁴ + A_3 x³ + A_2 x² + A_1 x + A_0
f'(x)=7A_7 x⁶ + 6A_6 x⁵ + 5A_5 x⁴ + 4A_4 x³ + 3A_3 x² + 2A_2 x + A_1
f''(x)=42A_7 x⁵ + 30A_6 x⁴ + 20A_5 x³ + 12A_4 x² + 6A_3 x + 2A_2
f'''(x)=210A_7 x⁴ + 120A_6 x³ + 60A_5 x² + 24A_4 x + 6A_3
归一化处理
f(0)=0
f(1)=1

f'(0)=v_0
f'(1)=v_1
f''(0)=a_0
f''(1)=a_1
f'''(0)=j_0
f'''(1)=j_1
可得出系数如下
A_0 = 0
A_1 = v_0
A_2 = 1 / 2 a_0
A_3 = 1 / 6 j_0
A_4 = -5 a_0 + 5 / 2 a_1 - 2 / 3 j_0 - 1 / 6 j_1 - 20v_0 - 15v_1 + 35
A_5 = 10a_0 - 7a_1 + j_0 + 1 / 2 j_1 + 45v_0 + 39v_1 - 84
A_6 = -15 / 2 a_0 + 13 / 2 a_1 - 2 / 3 j_0 - 1 / 2 j_1 - 36v_0 - 34v_1 + 70
A_7 = 2a_0 - 2a_1 + 1 / 6 j_0 + 1 / 6 j_1 + 10v_0 + 10v_1 - 20

通过以上公式可生成无比丝滑的凸轮曲线
以下曲线是通过七次多项式生成
位置&速度


位置&加速度
  

位置&加加速度
[ 此帖被uthman在2024-02-01 11:16重新编辑 ]
uthman
QQ:3749615
级别: 家园常客
精华主题: 1 篇
发帖数量: 442 个
工控威望: 800 点
下载积分: 2718 分
在线时间: 752(小时)
注册时间: 2007-10-25
最后登录: 2024-04-30
查看uthman的 主题 / 回贴
1楼  发表于: 2024-01-31 13:37
五次多项式推导
f(x)= A_5 x⁵ + A_4 x⁴ + A_3 x³ + A_2 x² + A_1 x + A_0
f'(x)=5A_5 x⁴ + 4A_4 x³ + 3A_3 x² + 2A_2 x + A_1
f''(x)=20A_5 x³ + 12A_4 x² + 6A_3 x + 2A_2
归一化处理
f(0)=0
f(1)=1

f'(0)=v_0
f'(1)=v_1
f''(0)=a_0
f''(1)=a_1
可得出系数如下
A_0 = 0
A_1 = v_0
A_2 = 1 / 2 a_0
A_3 = -3 / 2 a_0 + 1 / 2 a_1 - 6v_0 - 4v_1 + 10
A_4 = 3 / 2 a_0 - a_1 + 8v_0 + 7v_1 - 15
A_5 = -1 / 2 a_0 + 1 / 2 a_1 - 3v_0 - 3v_1 + 6

通过以上公式可生成位置&速度&加速度连续的凸轮曲线(加加速度存在突变)
以下曲线是通过五次多项式生成
位置&速度


位置&加速度


位置&加加速度
[ 此帖被uthman在2024-01-31 21:33重新编辑 ]
uthman
QQ:3749615
级别: 家园常客
精华主题: 1 篇
发帖数量: 442 个
工控威望: 800 点
下载积分: 2718 分
在线时间: 752(小时)
注册时间: 2007-10-25
最后登录: 2024-04-30
查看uthman的 主题 / 回贴
2楼  发表于: 2024-01-31 13:37
三次多项式推导
f(x)= A_3 x³ + A_2 x² + A_1 x + A_0
f'(x)=3A_3 x² + 2A_2 x + A_1
归一化处理
f(0)=0
f(1)=1

f'(0)=v_0
f'(1)=v_1
可得出系数如下
A_0 = 0
A_1 = v_0
A_2 = -2 v_0 - v_1 + 3
A_3 = v_0 + v_1 - 2

通过以上公式可生成位置&速度连续的凸轮曲线(加速度存在突变,加加速度存在冲击)
以下曲线是通过三次多项式生成
位置&速度


位置&加速度


位置&加加速度
[ 此帖被uthman在2024-01-31 21:35重新编辑 ]
uthman
QQ:3749615
级别: 家园常客
精华主题: 1 篇
发帖数量: 442 个
工控威望: 800 点
下载积分: 2718 分
在线时间: 752(小时)
注册时间: 2007-10-25
最后登录: 2024-04-30
查看uthman的 主题 / 回贴
3楼  发表于: 2024-01-31 13:38
留楼更新【三角函数规律】
uthman
QQ:3749615
级别: 家园常客
精华主题: 1 篇
发帖数量: 442 个
工控威望: 800 点
下载积分: 2718 分
在线时间: 752(小时)
注册时间: 2007-10-25
最后登录: 2024-04-30
查看uthman的 主题 / 回贴
4楼  发表于: 2024-01-31 13:40
因之前进行归一化处理,所以函数需进行缩放处理

主轴当前位置为φ
φi<=φ<=φk时执行,否则执行下一线段
当前线段主轴起点位置φi,终点位置φkikki
               从轴起点位置si,终点位置sk,Sik=sk-si
                                                     φik=(φ-φi)/Φik
                                                     sik=f(φik)*Sik
                                                     s=sik+si
[ 此帖被uthman在2024-02-01 14:30重新编辑 ]