实时调整机器人速度的力控打磨方法及系统技术方案

本发明专利技术提供了一种实时调整机器人速度的力控打磨方法及系统，包括：设置初始打磨路径和打磨力；实时处理传感器数据得到接触力；接触力和打磨力的偏差通过导纳控制器得到位置偏差；根据接触力实时调整速度比率；根据速度比率得到调整后的速度，调整后的速度转为位置发给机器人。本发明专利技术基于力传感器的机器人力控打磨方法只需简单示教加工轨迹即可自动调节打磨过程中的力；本发明专利技术针对分布不均的毛刺和去除材料，根据打磨力实时调整机器人路径速度，将过多的毛刺或材料去除，保证加工质量和加工效率；本发明专利技术基于力控制技术能够保证工件表面加工质量，提高打磨效率。提高打磨效率。提高打磨效率。

【技术实现步骤摘要】
实时调整机器人速度的力控打磨方法及系统


[0001]本专利技术涉及机器人力控打磨领域，具体地，涉及一种实时调整机器人速度的力控打磨方法及系统。

技术介绍

[0002]在工业领域，大量零部件加工完成后需要进行打磨处理，如铸造件表面，工件表面毛刺等，为满足自动化需求，工业机器人已经广泛用于打磨领域。现有打磨方法中，没有考虑工件去除材料不均造成磨头损坏和加工质量不高问题。针对工件表面毛刺分布不均问题，如何提供一种力控打磨方法，是当前需要解决的技术问题。
[0003]本专利技术提供实时调整机器人速度的力控打磨方法，针对毛刺或者去除材料分布不均的工件，机器人根据接触力的大小，实时调整机器人路径速度。如果接触力超过一定值，机器人路径速度自动减小，从而减小力，将过多的毛刺或材料去除，保证加工质量。
[0004]专利文献CN109366488A(申请号：CN201811494757.5)提出了一种面向机器人装配的叠加振荡力笛卡尔阻抗控制方法，所述方法包括以下步骤：步骤一、针对装配组件的插入阶段，结合阻抗控制原理进行动力学建模；步骤二、在笛卡尔空间对机械臂的组件装配系统建立基于位置的阻抗控制器模型；步骤三、对基于位置的阻抗控制器模型增加叠加振荡力，并分析叠加振荡力效果；步骤四、建立具有叠加振荡力的笛卡尔阻抗控制器模型。但该专利技术不能根据打磨力的不同实时调整机器人的路径速度。
[0005]专利文献CN108340247A(申请号：CN201810356324.7)公开了一种机器人抛光打磨系统，包括打磨抛光机构和搬运机器人，打磨抛光机构上设置有磨抛光组件，其包括打磨轮、打磨抛光砂带、打磨抛光电机和从动轮，打磨抛光组件通过打磨臂设置于打磨抛光基座上，打磨轮和从动轮分别转动设置，打磨抛光砂带绕设于打磨轮和从动轮上，打磨抛光电机驱动打磨轮和/或从动轮转动；打磨抛光基座上设置有力控装置，其包括力控摆臂、弹性件、力控气缸和电气比例阀，力控气缸依次通过弹性件、力控摆臂和打磨臂驱动打磨抛光组件相对打磨抛光基座移动，电气比例阀控制力控气缸，以调整最终作用于工件上的打磨抛光压力。但该专利技术不能根据打磨力的不同实时调整机器人的路径速度，实现对较厚的毛刺慢一点打磨，较薄的毛刺快一点打磨。

技术实现思路

[0006]针对现有技术中的缺陷，本专利技术的目的是提供一种实时调整机器人速度的力控打磨方法及系统。
[0007]根据本专利技术提供的一种实时调整机器人速度的力控打磨方法，包括：
[0008]步骤S1：设置初始打磨路径和打磨力；
[0009]步骤S2：实时处理传感器数据得到接触力；
[0010]步骤S3：接触力和打磨力的偏差通过导纳控制器得到位置偏差；
[0011]步骤S4：根据接触力实时调整速度比率；
[0012]步骤S5：根据速度比率得到调整后的速度，调整后的速度转为位置发给机器人。
[0013]优选地，在所述步骤S2中：
[0014]将打磨头的质量，质心参数传入控制器，做重力补偿，重力补偿是传感器测量力矩减去打磨头重力，得到接触力的过程。
[0015]优选地，在所述步骤S3中：
[0016]机器人控制打磨头接触工件表面，机器人采用力位混合控制模式，接触力和打磨力的偏差输入到导纳控制器，得到位置偏差，打磨力是外部输入参数，输入到控制器得到。
[0017]优选地，在所述步骤S4中：
[0018]接触力输入到速度控制模块，根据接触力的大小，调整速度比率，接触力设置两个层级level1和level2，速度比率设置三个层级max、mid和min，当接触力F>level2，速度比率调整到min，当接触力level1<F<level2，速度比率调整到mid，当接触力F<level1，速度比率调整到max；
[0019]为保证速度连续性，速度控制器采用PID控制方式。
[0020]优选地，在所述步骤S5中：
[0021]速度比率与初始路径速度相乘得到调整后的速度，初始路径速度是编程输入的打磨路径速度；
[0022]调整后的速度加上力控模块计算的位置偏差，得到的位置下发给机器人，控制机器人做打磨运动，实现实时调整机器人速度，以适应不均匀的毛刺和去除材料。
[0023]根据本专利技术提供的一种实时调整机器人速度的力控打磨系统，包括：
[0024]模块M1：设置初始打磨路径和打磨力；
[0025]模块M2：实时处理传感器数据得到接触力；
[0026]模块M3：接触力和打磨力的偏差通过导纳控制器得到位置偏差；
[0027]模块M4：根据接触力实时调整速度比率；
[0028]模块M5：根据速度比率得到调整后的速度，调整后的速度转为位置发给机器人。
[0029]优选地，在所述模块M2中：
[0030]将打磨头的质量，质心参数传入控制器，做重力补偿，重力补偿是传感器测量力矩减去打磨头重力，得到接触力的过程。
[0031]优选地，在所述模块M3中：
[0032]机器人控制打磨头接触工件表面，机器人采用力位混合控制模式，接触力和打磨力的偏差输入到导纳控制器，得到位置偏差，打磨力是外部输入参数，输入到控制器得到。
[0033]优选地，在所述模块M4中：
[0034]接触力输入到速度控制模块，根据接触力的大小，调整速度比率，接触力设置两个层级level1和level2，速度比率设置三个层级max、mid和min，当接触力F>level2，速度比率调整到min，当接触力level1<F<level2，速度比率调整到mid，当接触力F<level1，速度比率调整到max；
[0035]为保证速度连续性，速度控制器采用PID控制方式。
[0036]优选地，在所述模块M5中：
[0037]速度比率与初始路径速度相乘得到调整后的速度，初始路径速度是编程输入的打磨路径速度；
[0038]调整后的速度加上力控模块计算的位置偏差，得到的位置下发给机器人，控制机器人做打磨运动，实现实时调整机器人速度，以适应不均匀的毛刺和去除材料。
[0039]与现有技术相比，本专利技术具有如下的有益效果：
[0040]1、本专利技术基于力传感器的机器人力控打磨方法只需简单示教加工轨迹即可自动调节打磨过程中的力；
[0041]2、本专利技术针对分布不均的毛刺和去除材料，根据打磨力实时调整机器人路径速度，将过多的毛刺或材料去除，保证加工质量和加工效率；
[0042]3、本专利技术基于力控制技术能够保证工件表面加工质量，提高打磨效率；
[0043]4、本专利技术根据打磨力的不同实时调整机器人的进给速度，实现对较厚的毛刺慢一点打磨，较薄的毛刺快一点打磨，解决毛刺不均匀问题。
附图说明
[0044]通过阅读参照以下附图对非限制性实施例所作的详细描述，本专利技术本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种实时调整机器人速度的力控打磨方法，其特征在于，包括：步骤S1：设置初始打磨路径和打磨力；步骤S2：实时处理传感器数据得到接触力；步骤S3：接触力和打磨力的偏差通过导纳控制器得到位置偏差；步骤S4：根据接触力实时调整速度比率；步骤S5：根据速度比率得到调整后的速度，调整后的速度转为位置发给机器人。2.根据权利要求1所述的实时调整机器人速度的力控打磨方法，其特征在于，在所述步骤S2中：将打磨头的质量，质心参数传入控制器，做重力补偿，重力补偿是传感器测量力矩减去打磨头重力，得到接触力的过程。3.根据权利要求1所述的实时调整机器人速度的力控打磨方法，其特征在于，在所述步骤S3中：机器人控制打磨头接触工件表面，机器人采用力位混合控制模式，接触力和打磨力的偏差输入到导纳控制器，得到位置偏差，打磨力是外部输入参数，输入到控制器得到。4.根据权利要求1所述的实时调整机器人速度的力控打磨方法，其特征在于，在所述步骤S4中：接触力输入到速度控制模块，根据接触力的大小，调整速度比率，接触力设置两个层级level1和level2，速度比率设置三个层级max、mid和min，当接触力F>level2，速度比率调整到min，当接触力level1<F<level2，速度比率调整到mid，当接触力F<level1，速度比率调整到max；为保证速度连续性，速度控制器采用PID控制方式。5.根据权利要求1所述的实时调整机器人速度的力控打磨方法，其特征在于，在所述步骤S5中：速度比率与初始路径速度相乘得到调整后的速度，初始路径速度是编程输入的打磨路径速度；调整后的速度加上力控模块计算的位置偏差，得到的位置下发给机器人，控制机器人做打磨运动，实现实时调整机器人速度，以适应不均匀的毛刺和去除材料。6.一种实时调...

【专利技术属性】
技术研发人员：王永超，郭震，
申请(专利权)人：上海景吾智能科技有限公司，
类型：发明
国别省市：