一种连续加工路径的速度曲线规划方法与流程

文档序号:26100595发布日期:2021-07-30 18:11阅读:来源:国知局

技术特征:

1.一种连续加工路径的速度曲线规划方法,包括前瞻段,其特征在于,对所述前瞻段的固定段长采用分时处理的方法,且该方法包括以下实施方案:

步骤一:对划分的所述前瞻段再进行分小段前瞻,依次往后递推,对小段曲线先进行前推,获得前推速度,保证前推速度小于等于拐点速度限制;

步骤二:对不满足前推条件的点再进行回溯,获得回溯速度,回溯速度大于前推速度时,满足要求,则此小段前瞻结束;

步骤三:若所述回溯速度小于前推速度,则回溯速度不满足要求,继续往前回溯,直至回溯速度大于前推速度;

步骤四:若回溯到小段的首段曲线仍不满足要求时,此时需要修改首段加加速度来改变回溯速度进而获得首段的目标速度。

2.根据权利要求1所述的一种连续加工路径的速度曲线规划方法,其特征在于,首先对所述前瞻取固定段长,约定本前瞻段的起点和终点速度为0,基于控制器一个周期内有多任务需处理,对本前瞻段进行划分,控制器对本前瞻段分时处理,先处理本前瞻段的小段,对小段处理完后,从小段处理结束处往后再移固定段数,保证固定段数的最后一个点速度为0,然后划分小段,控制器进行相同处理。

3.根据权利要求2所述的一种连续加工路径的速度曲线规划方法,其特征在于,对本前瞻段划分的当前规划段进行速度前瞻规划时,采用前推方法,按照加速规律,计算拐点前推速度,并保证前推速度小于等于拐点最大速度;

所述步骤三中的当前规划段的拐点都满足前推条件则无需回溯,得到的回溯速度大于前推速度,则回溯速度满足条件,结束当前规划段速度规划;

若不满足,则按照上述方法将得到的回溯速度继续反向推导前一点的回溯速度,直至满足条件;

对于得到目标速度的点,将其作为起点,将得到的预估速度作为起点速度,长度为开始选取好的固定段数,并保证终点速度为0,按照上述步骤依次划分小段进行速度前瞻规划,直至前瞻结束;

若反向计算到当前规划段的首段,所述回溯速度仍不满足条件,此时需要修改加加速度来改变回溯速度,使其满足条件,这样当前规划段速度前瞻规划结束。

4.根据权利要求3所述的一种连续加工路径的速度曲线规划方法,其特征在于,所述前瞻段的算法主要分为四个模块:数据过滤模块、前瞻模块、加减速模块和插补模块。

5.根据权利要求4所述的一种连续加工路径的速度曲线规划方法,其特征在于,其中所述插补模块每个插补周期都会被调度,负责在每个插补周期输出位移驱动各电机运动。

6.根据权利要求5所述的一种连续加工路径的速度曲线规划方法,其特征在于,所述插补模块根据所述数据过滤模块过滤出的各数据段和所述前瞻模块计算出各数据段的运动参数,调用加减速模块的位置计算函数,计算出下个插补周期的位置点,再根据数据过滤模块计算出的数据段与坐标轴的夹角,驱动分轴运动。

7.根据权利要求6所述的一种连续加工路径的速度曲线规划方法,其特征在于,若缓存区有n条轨迹线段待处理,首先取前瞻固定段长为100,控制器插补周期为1ms,控制器对本前瞻段分时处理,本前瞻段被分为5段进行处理,固定段长约定v1和v101拐点速度为0;拐点最大速度vmax:对于直线受直线过渡误差、拐角加速度、拐点上下段最大速度限制,对于圆弧受弓高误差、拐角加速度、离心加速度、拐点上下段速度限制。前瞻段的前推和回溯速度受拐点最大速度限制。

8.根据权利要求7所述的一种连续加工路径的速度曲线规划方法,其特征在于,对本前瞻段分段后,p1-p21点为第一个规划段,要计算的拐点速度即v1-v21,对这20段进行前推,当前一个点的前推速度小于当前点的前推速度时则继续前推,即vi_forward<vi+1_forward则满足前推条件,如果当前规划段内有不满足前推条件的点时,则停止前推,并进行回溯。

9.根据权利要求8所述的一种连续加工路径的速度曲线规划方法,其特征在于,对所述本前瞻段分时处理得到满足前推条件的点为pk(1≤k≤21)点的前推速度vk_forward,然后从pk点进行回溯,得到对应的回溯速度vk_backward,vk_backward≥vk_forward时则满足条件,此时可计算得到本规划段的末端速度v1_e;

若vk_backward<vk_forward则不满足条件,需要再往前回溯,直至vj_backward≥vj_forward满足条件,则此段速度规划完成;若回溯到本规划段的第一个点回溯速度仍不满足条件,此时需要修改回溯速度,不然前瞻会报错,增加首段的最大加加速度jmax来保证首段的回溯速度满足条件,可以得到的首段最大加加速度j1_backward,得到首段的最大加加速度j1_backward后,由此可计算得到首段的回溯速度。

10.根据权利要求9所述的一种连续加工路径的速度曲线规划方法,其特征在于,假设第一个规划段回溯速度满足的点为j(1≤j≤21),得到末端速度为vj,e,因为前瞻的固定段长为100,所以此时前瞻段变为pj-pj+100,pj点的起始速度为vj,e,pj+100点的速度为0,cpu对此前瞻段依然分时处理,规划段变为pj-pj+20,前推+回溯的方法进行速度规划得到末端速度,依此类推,直至前瞻结束。


技术总结
本发明属于数控系统技术领域,尤其是一种连续加工路径的速度曲线规划方法,包括前瞻段,对所述前瞻段的固定段长采用分时处理的方法,且该方法包括以下实施方案:步骤一:对划分的所述前瞻段再进行分小段前瞻,依次往后递推,对小段曲线先进行前推,获得前推速度,保证前推速度小于等于拐点速度限制;步骤二:对不满足前推条件的点再进行回溯,获得回溯速度,回溯速度大于前推速度时,满足要求,则此小段前瞻结束。本发明对速度前瞻规划采用前推+回溯相结合的简化方法,对回溯速度不满足时采取了再继续回溯的方法,回溯到首段仍不满足时,进行修改加加速度回溯,解决了回溯速度不满足的情况,使速度曲线更平稳。

技术研发人员:陈利敏;吴然;张辉;魏旭东;崔筱玮
受保护的技术使用者:无锡信捷电气股份有限公司
技术研发日:2021.03.13
技术公布日:2021.07.30
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1