希望UR执行力控指令时,使用一个周期内的平均值进行计算当前所受到外力,这样可以准确地以我设定的力接触工作表面。
UR5e末端工具高频震动,频率50hz-70hz可调。工具重量及重心设置准确后,工具不接触工作表面,每2ms采集机器人Z方向力控值,得到如下曲线:
可以计算当前震动频率约为70hz,每个周期内采样了7~8个数据,震动对机器人造成的反作用力是很有规律的,后来我多次采样发现,不同的工具震动峰值正负值并不一定相同(推测是工具产品差异),一个周期内平均值并不一定为0。
目前UR执行力控指令时,对工作表面的压力不稳定,有时会大于设定值,按压力度过大;有时会飘起来,无法接触工作表面。猜测与高频震动对UR造成的反作用力相关,因此在执行力控指令时,我计划首先把一个周期内的平均值附加到力控指令设定值里,然后以一个周期内的平均值判断当前所受的外力,
请各位同仁评价一下我这个方案是否合理?如合理,机器人执行力控指令时,如何让其实时的以一个周期内的平均值作为当前所受外力值?