买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：成都乐创自动化技术股份有限公司

摘要：本发明公开了一种基于多级S型上升的多轴机器的大段速度前瞻的方法，将轨迹划分为若干个微段，将其中连续的多个微段划分为一个大段；然后将大段的速度提升分为n级S型速度上升，且各级的速度上下限，加速度，加加速度不同。本发明采用分级式S型升速法，允许物理轴加速度，加加速度能一定范围内在一些地方超过设定值。本发明可适用于多轴联动控制加工，使得运动更加平滑柔顺，而且大大减少了计算量，提升了运行效率；也提供了一个高效，平稳的S型速度前瞻通用方案，具有较好的实用性。

主权项：1.一种基于多级S型上升的多轴机器的大段速度前瞻的方法，其特征在于，将轨迹划分为若干个微段，将其中连续的多个微段划分为一个大段；然后将大段的速度提升分为n级S型速度上升，且各级的速度上下限，加速度，加加速度不同；包括以下步骤：步骤A1：初始化大段的各级速度上限{VRefer1,VRefer2,VRefer3,…,VRefern}，各级最小加速度{minA1,minA2,minA3,…,minAn}，各级最小加加速度{minJ1,minJ2,minJ3,…,minJn}；其中，大段的各级最小加速度minAn等于大段的所有微段的加速度最小值minA；各级最小加加速度minJn等于整个连续轨迹的最大加加速度wholeJerkmax；VRefern=min（MinVByAcc，MinVByJerk）×VreferScalen，其中：MinVByAcc为大段的所有微段的加速度限制的速度上限最小值；MinVByJerk为大段的所有微段的加加速度限制的速度上限最小值；VReferScalen为第n级最大速度占据加速度和加加速度限制的最大速度比例；步骤A2：计算得到大段的当前长度： Line.L=Line.L0+line.l，其中：Line.L0为当前微段前的大段的长度； Line.L为当前大段的长度； line.l为当前微段的长度；步骤A3：计算当前的各级最小加速度{minA1,minA2,minA3,…,minAn}；minAn=min（minAn，Acc），Acc=wholeAxisVmax[k]×ratioA÷ratioL，ratioA=1-ratioAn+AOverflowScale，ratioAn=ratioVn2，ratioVn=VRefern÷VLimitByAcc，其中：Acc为当前物理轴k限制的虚拟轴的加速度；wholeAxisVmax[k]为物理轴k的最大速度；ratioA为当前物理轴k的加速度占设定加速度的比值；ratioAn为第n级到速度上限时，轨迹曲率匀速运动的物理轴k的加速度与设定加速度的比值；ratioVn为第n级速度VRefern与当前微段的加速度限制的速度上限的比值；ratioL为物理轴k位移与虚拟轴位移的比值；AOverflowScale为加速度可超过设定加速度的值与设定加速度的比值；VLimitByAcc为当前微段的加速度限制的速度上限；步骤A4：计算当前的各级最小加加速度{minJ1,minJ2,minJ3,…,minJn}；minJn=min（minJn，Jerk），Jerk=wholeAxisJerkmax[k]×ratioJ÷ratioL，ratioJ=1-ratioJn+JOverflowScale，ratioJn=ratioVn3，ratioVn=VRefern÷VLimitByJerk，其中：Jerk为当前S型速度曲线的加加速度；wholeAxisJerkmax[k]为物理轴k的最大加加速度；ratioJ为当前物理轴k的加速度占设定加加速度的比值；ratioJn为第n级到速度上限时，轨迹曲率匀速运动的物理轴k的加加速度与设定加加速度的比值；ratioVn为第n级速度VRefern与当前微段的加加速度限制的速度上限的比值；VLimitByJerk当前微段的加加速度限制的速度上限；JOverflowScale为加加速度可超过设定加加速度的值与设定加加速度的比值；步骤A5：若当前微段为大段的最后一个微段，则进入步骤A6，否则进入步骤A2；步骤A6：将大段的各级加速度{A1,A2,A3,…,An}更新为步骤A3计算的各级最小加速度{minA1,minA2,minA3,…,minAn}；将大段的各级加加速度{J1,J2,J3,…,Jn}更新为步骤A4计算的各级最小加加速度{minJ1,minJ2,minJ3,…,minJn}。

全文数据：

权利要求：

百度查询： 成都乐创自动化技术股份有限公司 一种基于多级S型上升的多轴机器的大段速度前瞻的方法