CN112558486A - 一种温度控制的机器人打磨方法及计算机可读存储介质 - Google Patents

一种温度控制的机器人打磨方法及计算机可读存储介质 Download PDF

Info

Publication number
CN112558486A
CN112558486A CN202110200123.XA CN202110200123A CN112558486A CN 112558486 A CN112558486 A CN 112558486A CN 202110200123 A CN202110200123 A CN 202110200123A CN 112558486 A CN112558486 A CN 112558486A
Authority
CN
China
Prior art keywords
robot
temperature
joint angular
acceleration
polishing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110200123.XA
Other languages
English (en)
Other versions
CN112558486B (zh
Inventor
陈仕晰
徐恩华
吕晓静
徐燕
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Foshan Longshen Robot Co Ltd
Original Assignee
Foshan Longshen Robot Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Foshan Longshen Robot Co Ltd filed Critical Foshan Longshen Robot Co Ltd
Priority to CN202110200123.XA priority Critical patent/CN112558486B/zh
Publication of CN112558486A publication Critical patent/CN112558486A/zh
Application granted granted Critical
Publication of CN112558486B publication Critical patent/CN112558486B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
  • Manipulator (AREA)

Abstract

本发明提供一种温度控制的机器人打磨方法及计算机可读存储介质，所述机器人打磨方法包括如下步骤：采集打磨过程中工件表面温度并根据预设最优打磨温度、预设打磨接触力以及工件表面温度构建温度控制器以对期望打磨接触力进行修正；以期望轨迹信息以及修正后的期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度；根据修正后的机器人末端执行器在任务空间的期望加速度获取机器人的当前关节角加速度；计算机器人的当前关节角加速度的更新率并迭代更新机器人的期望关节角加速度；构建机器人的动力学模型并根据动力学模型获取机器人的动力学控制器以实现机器人的打磨控制。本发明可有效保证工件的打磨质量。

Description

一种温度控制的机器人打磨方法及计算机可读存储介质
技术领域
本发明涉及机器人技术领域，具体而言，涉及一种温度控制的机器人打磨方法及计算机可读存储介质。
背景技术
抛光打磨是在铸锻件、冲压成型件、焊接件等产品加工过程后段，提高产品表面质量的必备工艺。抛光打磨通常采用砂纸、砂轮等工具摩擦产品表面来改变产品表面物理形态，以达到提高产品表面的精度与粗糙度的目的。现阶段抛光打磨作业多以人工为主，由于抛光打磨过程通常伴随大量粉尘、火花等，工作环境比较恶劣，容易对人类身体造成严重伤害，同时采用人工作业的方式劳动强度非常大，效率也不高。采用机器人进行抛光打磨可以有效解决人工抛光打磨作业所存在的容易对人类身体造成严重伤害、劳动强度大以及效率不高的问题。
然而采用机器人对飞机蒙皮等加工质量要求较高的产品进行抛光打磨时，容易出现因产品局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题。
发明内容
基于此，为了解决采用机器人对产品进行抛光打磨时，容易出现因产品局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题，本发明提供了一种温度控制的机器人打磨方法，其具体技术方案如下：
一种温度控制的机器人打磨方法，包括如下步骤：
采集打磨过程中工件表面温度
Figure 795624DEST_PATH_IMAGE001
，并根据预设最优打磨温度
Figure 635404DEST_PATH_IMAGE002
、预设打磨接触力
Figure 116063DEST_PATH_IMAGE003
以及所述工件表面温度
Figure 408505DEST_PATH_IMAGE004
构建温度控制器以对期望打磨接触力进行修正；
以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度；
根据所述修正后的机器人末端执行器在任务空间的期望加速度获取所述机器人的当前关节角加速度；
计算所述机器人的当前关节角加速度的更新率，并根据所述更新率迭代更新所述机器人的期望关节角加速度；
构建所述机器人的动力学模型，并根据所述动力学模型获取所述机器人的动力学控制器以实现所述机器人的打磨控制。
通过采集打磨过程中工件表面温度，并基于所述工件表面温度构建温度控制器，以对所述期望打磨接触力进行修正，然后以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度，并计算所述机器人的当前关节角加速度的更新率，最后根据所述更新率迭代更新所述机器人的期望关节角加速度以实现所述机器人的打磨控制，可以避免出现在抛光打磨过程中工件局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题。
进一步地，所述温度控制器的公式为
Figure 203285DEST_PATH_IMAGE005
，其中，
Figure 897572DEST_PATH_IMAGE006
为预设控制参数，
Figure 549133DEST_PATH_IMAGE007
为修正后的所述期望打磨接触力。
进一步地，以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度的具体方法包括如下步骤：
构建质量-弹簧-阻尼模型
Figure 594449DEST_PATH_IMAGE009
；
根据所述质量-弹簧-阻尼模型计算修正后的机器人末端执行器在任务空间的期望加速度
Figure 989659DEST_PATH_IMAGE010
；
其中，
Figure 725402DEST_PATH_IMAGE011
、
Figure 813444DEST_PATH_IMAGE012
、
Figure 80477DEST_PATH_IMAGE013
均为阻抗参数，
Figure 13798DEST_PATH_IMAGE014
、
Figure 682677DEST_PATH_IMAGE015
、
Figure 879303DEST_PATH_IMAGE016
分别为修正后的机器人末端执行器的期望位置、期望速度与期望加速度，
Figure 368053DEST_PATH_IMAGE017
、
Figure 370644DEST_PATH_IMAGE018
、
Figure 894030DEST_PATH_IMAGE019
分别为预定义的机器人末端执行器的期望位置、期望速度与期望加速度,
Figure 58295DEST_PATH_IMAGE020
为当前实际测量的打磨接触力。
进一步地，机器人的当前关节角加速度满足约束公式
Figure 299920DEST_PATH_IMAGE021
、
Figure 33433DEST_PATH_IMAGE022
以及
Figure 411325DEST_PATH_IMAGE023
；其中，
Figure 12070DEST_PATH_IMAGE024
为所述机器人的雅克比矩阵，
Figure 475413DEST_PATH_IMAGE025
、
Figure 819806DEST_PATH_IMAGE026
分别为所述机器人的当前关节角加速度的下限与上限,
Figure 255467DEST_PATH_IMAGE023
表示取使
Figure 761535DEST_PATH_IMAGE027
为最小值的一个
Figure 977752DEST_PATH_IMAGE028
。
当所述机器人的当前关节角加速度满足约束公式
Figure 860258DEST_PATH_IMAGE029
以及
Figure 212742DEST_PATH_IMAGE030
时，所述机器人的当前关节角加速度并不唯一。即是说具有多个所述机器人的当前关节角加速度可以满足约束公式
Figure 76661DEST_PATH_IMAGE029
以及
Figure 514596DEST_PATH_IMAGE030
。通过约束公式
Figure 200792DEST_PATH_IMAGE031
取使
Figure 407782DEST_PATH_IMAGE032
为最小值的一个
Figure 521232DEST_PATH_IMAGE028
，可以有效满足所述机器人在打磨过程中的加速度约束。
进一步地，根据公式
Figure 446463DEST_PATH_IMAGE033
计算所述机器人的当前关节角加速度的更新率；其中，
Figure 608454DEST_PATH_IMAGE034
为辅助变量，
Figure 935530DEST_PATH_IMAGE035
为
Figure 219881DEST_PATH_IMAGE036
的导数，
Figure 366828DEST_PATH_IMAGE037
为所述机器人的当前关节角速度，
Figure 394827DEST_PATH_IMAGE038
为辅助变量
Figure 576410DEST_PATH_IMAGE034
的更新率，
Figure 218613DEST_PATH_IMAGE039
为预设的内环控制器参数且
Figure 118435DEST_PATH_IMAGE040
，
Figure 684546DEST_PATH_IMAGE041
。
进一步地，根据所述更新率迭代更新所述机器人的期望关节角加速度的具体方法包括如下步骤：
计算当前时刻T的所述机器人的当前关节角加速度的更新率
Figure 720635DEST_PATH_IMAGE042
；
计算当前时刻T的所述辅助变量
Figure 346789DEST_PATH_IMAGE034
的更新率
Figure 406011DEST_PATH_IMAGE043
；
根据所述机器人的当前关节角加速度的更新率
Figure 775813DEST_PATH_IMAGE042
以及所述辅助变量
Figure 931988DEST_PATH_IMAGE044
的更新率
Figure 729042DEST_PATH_IMAGE043
获取迭代更新公式
Figure 337878DEST_PATH_IMAGE045
；
根据所述迭代更新公式对所述机器人的期望关节角加速度
Figure 245791DEST_PATH_IMAGE046
进行迭代更新。
进一步地，所述机器人的动力学模型的公式为
Figure 443423DEST_PATH_IMAGE048
，其中，
Figure 411379DEST_PATH_IMAGE049
、
Figure 507511DEST_PATH_IMAGE050
、
Figure 219115DEST_PATH_IMAGE051
、
Figure 349883DEST_PATH_IMAGE052
分别为所述机器人的惯性矩阵、哥矢力与离心力矩阵、重力矩、摩擦力与扰动力矩，
Figure 488740DEST_PATH_IMAGE053
为所述机器人的当前关节角度，
Figure 744272DEST_PATH_IMAGE054
为所述机器人的控制力矩。
进一步地，所述机器人的动力学控制器的公式为
Figure 259567DEST_PATH_IMAGE055
，其中
Figure 244840DEST_PATH_IMAGE056
，
Figure 554599DEST_PATH_IMAGE057
、
Figure 359744DEST_PATH_IMAGE058
以及
Figure 600101DEST_PATH_IMAGE059
均为正常数，
Figure 439881DEST_PATH_IMAGE060
为所述机器人的期望关节角速度，
Figure 920541DEST_PATH_IMAGE061
为所述机器人的期望关节角度。
本发明还提供一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序，当所述计算机程序被处理器执行时实现如上述所述的一种温度控制的机器人打磨方法。
附图说明
从以下结合附图的描述可以进一步理解本发明。图中的部件不一定按比例绘制，而是将重点放在示出实施例的原理上。在不同的视图中，相同的附图标记指定对应的部分。
图1是本发明一实施例中一种温度控制的机器人打磨方法的整体流程示意图。
具体实施方式
为了使得本发明的目的、技术方案及优点更加清楚明白，以下结合其实施例，对本发明进行进一步详细说明。应当理解的是，此处所描述的具体实施方式仅用以解释本发明，并不限定本发明的保护范围。
需要说明的是，当元件被称为“ 固定于”另一个元件，它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“ 连接”另一个元件，它可以是直接连接到另一个元件或者可能同时存在居中元件。本文所使用的术语“ 垂直的”、“ 水平的”、“左”、“ 右”以及类似的表述只是为了说明的目的，并不表示是唯一的实施方式。
除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施方式的目的，不是旨在于限制本发明。本文所使用的术语“ 及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
本发明中所述“ 第一”、“ 第二”不代表具体的数量及顺序，仅仅是用于名称的区分。
如无特别说明，以下描述中的变量均对时间略写，如
Figure 478561DEST_PATH_IMAGE062
简写为
Figure 70080DEST_PATH_IMAGE063
，
Figure 29946DEST_PATH_IMAGE064
简写为
Figure 619190DEST_PATH_IMAGE065
。唯一特殊情况是对前一时刻变量与后一时刻变量进行区分时，将括号中的时间写上，如
Figure 398927DEST_PATH_IMAGE066
与
Figure 794136DEST_PATH_IMAGE067
分别指
Figure 608509DEST_PATH_IMAGE068
时刻与
Figure 430971DEST_PATH_IMAGE069
时刻变量
Figure 884955DEST_PATH_IMAGE070
的值。
如图1所示，本发明一实施例中的一种温度控制的机器人打磨方法，包括如下步骤：
采集打磨过程中工件表面温度
Figure 83855DEST_PATH_IMAGE001
，并根据预设最优打磨温度
Figure 752734DEST_PATH_IMAGE002
、预设打磨接触力
Figure 746098DEST_PATH_IMAGE003
以及所述工件表面温度
Figure 500427DEST_PATH_IMAGE004
构建温度控制器以对期望打磨接触力进行修正；
以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度；
根据所述修正后的机器人末端执行器在任务空间的期望加速度获取所述机器人的当前关节角加速度；
计算所述机器人的当前关节角加速度的更新率，并根据所述更新率迭代更新所述机器人的期望关节角加速度；
构建所述机器人的动力学模型，并根据所述动力学模型获取所述机器人的动力学控制器以实现所述机器人的打磨控制。
所述温度控制的机器人打磨方法通过采集打磨过程中工件表面温度，并基于所述工件表面温度构建温度控制器，以对所述期望打磨接触力进行修正，然后以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度，并计算所述机器人的当前关节角加速度的更新率，最后根据所述更新率迭代更新所述机器人的期望关节角加速度以实现所述机器人的打磨控制，可以避免出现在抛光打磨过程中工件局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题。
在其中一个实施例中，通过温度传感器采集打磨过程中工件表面温度。
在其中一个实施例中，所述温度控制器的公式为
Figure 503018DEST_PATH_IMAGE005
，其中，
Figure 964086DEST_PATH_IMAGE006
为预设控制参数，
Figure 128352DEST_PATH_IMAGE007
为修正后的所述期望打磨接触力。即是说，当所述工件表面温度
Figure 369977DEST_PATH_IMAGE071
小于预设最优打磨温度
Figure 910680DEST_PATH_IMAGE072
时，以预设打磨接触力
Figure 288572DEST_PATH_IMAGE073
为修正后的所述期望打磨接触力
Figure 76268DEST_PATH_IMAGE007
；当所述工件表面温度
Figure 539610DEST_PATH_IMAGE074
等于或大于预设最优打磨温度
Figure 884004DEST_PATH_IMAGE075
时，先计算预设最优打磨温度
Figure 116402DEST_PATH_IMAGE076
与所述工件表面温度
Figure 888049DEST_PATH_IMAGE077
的差与预设控制参数
Figure 838687DEST_PATH_IMAGE006
的乘积，然后再以预设打磨接触力
Figure 658876DEST_PATH_IMAGE078
与该乘积的和为修正后的所述期望打磨接触力
Figure 11360DEST_PATH_IMAGE007
。
在其中一个实施例中，所述以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度的具体方法包括如下步骤：
构建质量-弹簧-阻尼模型
Figure 953908DEST_PATH_IMAGE079
；
根据所述质量-弹簧-阻尼模型计算修正后的机器人末端执行器在任务空间的期望加速度
Figure 391843DEST_PATH_IMAGE080
；
其中，
Figure 78039DEST_PATH_IMAGE011
、
Figure 285029DEST_PATH_IMAGE081
、
Figure 585430DEST_PATH_IMAGE013
均为阻抗参数，
Figure 510660DEST_PATH_IMAGE082
、
Figure 734968DEST_PATH_IMAGE083
、
Figure 62044DEST_PATH_IMAGE084
分别为修正后的机器人末端执行器的期望位置、期望速度与期望加速度，
Figure 80816DEST_PATH_IMAGE017
、
Figure 431026DEST_PATH_IMAGE018
、
Figure 459025DEST_PATH_IMAGE019
分别为预定义的机器人末端执行器的期望位置、期望速度与期望加速度,
Figure 640607DEST_PATH_IMAGE085
为当前实际测量的打磨接触力。
在其中一个实施例中，机器人的当前关节角加速度满足约束公式
Figure 95859DEST_PATH_IMAGE086
、
Figure 730103DEST_PATH_IMAGE087
以及
Figure 296214DEST_PATH_IMAGE031
；其中，
Figure 802411DEST_PATH_IMAGE024
为所述机器人的雅克比矩阵，
Figure 428564DEST_PATH_IMAGE088
、
Figure 550104DEST_PATH_IMAGE089
分别为所述机器人的当前关节角加速度的下限与上限,
Figure 919905DEST_PATH_IMAGE031
表示取使
Figure 76080DEST_PATH_IMAGE032
为最小值的一个
Figure 873135DEST_PATH_IMAGE028
。
当所述机器人的当前关节角加速度满足约束公式
Figure 419654DEST_PATH_IMAGE029
以及
Figure 327567DEST_PATH_IMAGE030
时，所述机器人的当前关节角加速度并不唯一。即是说具有多个所述机器人的当前关节角加速度可以满足约束公式
Figure 338248DEST_PATH_IMAGE029
以及
Figure 306204DEST_PATH_IMAGE030
。通过约束公式
Figure 402336DEST_PATH_IMAGE031
取使
Figure 300891DEST_PATH_IMAGE032
为最小值的一个
Figure 166079DEST_PATH_IMAGE028
，可以有效满足所述机器人在打磨过程中的加速度约束。
在其中一个实施例中，根据公式
Figure 304936DEST_PATH_IMAGE091
计算所述机器人的当前关节角加速度的更新率，其中，
Figure 888364DEST_PATH_IMAGE034
为辅助变量，
Figure 403659DEST_PATH_IMAGE035
为
Figure 123354DEST_PATH_IMAGE036
的导数，
Figure 370795DEST_PATH_IMAGE092
为辅助变量
Figure 441520DEST_PATH_IMAGE044
的更新率，
Figure 494926DEST_PATH_IMAGE093
为所述机器人的当前关节角速度，
Figure 334706DEST_PATH_IMAGE094
为预设的内环控制器参数且
Figure 815366DEST_PATH_IMAGE040
,
Figure 373386DEST_PATH_IMAGE095
。
在其中一个实施例中，根据所述更新率迭代更新所述机器人的期望关节角加速度的具体方法包括如下步骤：
计算当前时刻T的所述机器人的当前关节角加速度的更新率
Figure 151855DEST_PATH_IMAGE096
；
计算当前时刻T的所述辅助变量
Figure 846142DEST_PATH_IMAGE034
的更新率
Figure 763282DEST_PATH_IMAGE097
；
根据所述机器人的当前关节角加速度的更新率
Figure 543020DEST_PATH_IMAGE096
以及所述辅助变量
Figure 938229DEST_PATH_IMAGE044
的更新率
Figure 752601DEST_PATH_IMAGE097
获取迭代更新公式
Figure 512747DEST_PATH_IMAGE045
；
根据所述迭代更新公式对所述机器人的期望关节角加速度
Figure 779780DEST_PATH_IMAGE046
进行迭代更新。
在其中一个实施例中，所述机器人的动力学模型的公式为
Figure 978680DEST_PATH_IMAGE099
；其中，
Figure 647559DEST_PATH_IMAGE100
、
Figure 640923DEST_PATH_IMAGE101
、
Figure 582203DEST_PATH_IMAGE102
、
Figure 319215DEST_PATH_IMAGE103
分别为所述机器人的惯性矩阵、哥矢力与离心力矩阵、重力矩、摩擦力与扰动力矩，
Figure 842600DEST_PATH_IMAGE104
为所述机器人的当前关节角度，
Figure 272444DEST_PATH_IMAGE054
为所述机器人的控制力矩。
在其中一个实施例中，所述机器人的动力学控制器的公式为
Figure 514070DEST_PATH_IMAGE055
；其中
Figure 789193DEST_PATH_IMAGE056
，
Figure 370347DEST_PATH_IMAGE105
、
Figure 705514DEST_PATH_IMAGE106
以及
Figure 434435DEST_PATH_IMAGE059
均为正常数，
Figure 513250DEST_PATH_IMAGE060
为所述机器人的期望关节角速度，
Figure 11227DEST_PATH_IMAGE107
为所述机器人的期望关节角度。
所述机器人的期望关节角速度以及所述机器人的期望关节角度根据公式
Figure 782874DEST_PATH_IMAGE108
。
进行计算更新。
通过构建动力学模型以及动力学控制器，所述温度控制的机器人打磨方法充分考虑了所述机器人的动力学因素，可以实现所述机器人对打磨过程的高精度控制。
在其中一个实施例中，所述温度控制的机器人打磨方法还包括构建内环控制器，所述修正后的机器人末端执行器在任务空间的期望加速度为所述内环控制器的输入，所述内环控制器用于根据所述修正后的机器人末端执行器在任务空间的期望加速度获取所述机器人的控制力矩
Figure 920463DEST_PATH_IMAGE109
。
通过构建所述温度控制器，可获取基于工件表面温度的机器人外环力控制策略，所述温度控制的机器人打磨方法避免了出现在抛光打磨过程中工件局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题。
而通过构建内环控制器，则可获取机器人内环力控制策略，所述温度控制的机器人打磨方法不仅能够避免出现在抛光打磨过程中工件局部温度过高而导致产品材料退火、变形甚至物理性质发生改变的问题，还可以所述机器人对工件的柔顺贴合，提供精确的力控制。
在其中一个实施例中，本发明提供一种计算机可读存储介质，所述计算机可读存储介质存储有计算机程序，当所述计算机程序被处理器执行时实现如上述所述的一种温度控制的机器人打磨方法。
以上所述实施例的各技术特征可以进行任意的组合，为使描述简洁，未对上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。

Claims (9)

1.一种温度控制的机器人打磨方法，其特征在于，包括如下步骤：
采集打磨过程中工件表面温度
Figure 648613DEST_PATH_IMAGE001
，并根据预设最优打磨温度
Figure 505711DEST_PATH_IMAGE002
、预设打磨接触力
Figure 199997DEST_PATH_IMAGE003
以及所述工件表面温度
Figure 851558DEST_PATH_IMAGE004
构建温度控制器以对期望打磨接触力进行修正；
以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度；
根据所述修正后的机器人末端执行器在任务空间的期望加速度修正所述机器人的当前关节角加速度；
计算所述机器人的当前关节角加速度的更新率，并根据所述更新率迭代更新所述机器人的期望关节角加速度；
构建所述机器人的动力学模型，并根据所述动力学模型获取所述机器人的动力学控制器以实现所述机器人的打磨控制。
2.如权利要求1所述的一种温度控制的机器人打磨方法，其特征在于，所述温度控制器的公式为
Figure 89685DEST_PATH_IMAGE005
，其中，
Figure 484894DEST_PATH_IMAGE006
为预设控制参数，
Figure 33687DEST_PATH_IMAGE007
为修正后的所述期望打磨接触力。
3.如权利要求2所述的一种温度控制的机器人打磨方法，其特征在于，以所述机器人的期望轨迹信息以及修正后的所述期望打磨接触力作为导纳控制器的输入，计算修正后的机器人末端执行器在任务空间的期望加速度的具体方法包括如下步骤：
构建质量-弹簧-阻尼模型
Figure 121729DEST_PATH_IMAGE008
；
根据所述质量-弹簧-阻尼模型计算修正后的机器人末端执行器在任务空间的期望加速度
Figure 388762DEST_PATH_IMAGE009
；
其中，
Figure 525345DEST_PATH_IMAGE010
、
Figure 928645DEST_PATH_IMAGE011
、
Figure 187588DEST_PATH_IMAGE012
均为阻抗参数，
Figure 941917DEST_PATH_IMAGE013
、
Figure 678929DEST_PATH_IMAGE014
、
Figure 202314DEST_PATH_IMAGE015
分别为修正后的机器人末端执行器的期望位置、期望速度与期望加速度，
Figure 819109DEST_PATH_IMAGE016
、
Figure 795156DEST_PATH_IMAGE017
、
Figure 335858DEST_PATH_IMAGE018
分别为预定义的机器人末端执行器的期望位置、期望速度与期望加速度,
Figure 979329DEST_PATH_IMAGE019
为当前实际测量的打磨接触力。
4.如权利要求3所述的一种温度控制的机器人打磨方法，其特征在于，所述机器人的当前关节角加速度
Figure 314496DEST_PATH_IMAGE020
满足约束公式
Figure 981100DEST_PATH_IMAGE022
、
Figure 59915DEST_PATH_IMAGE023
以及
Figure 557892DEST_PATH_IMAGE024
；其中，
Figure 63960DEST_PATH_IMAGE025
为所述机器人的雅克比矩阵，
Figure 280178DEST_PATH_IMAGE026
、
Figure 162683DEST_PATH_IMAGE027
分别为所述机器人的当前关节角加速度的下限与上限,
Figure 702118DEST_PATH_IMAGE028
表示取使
Figure 644666DEST_PATH_IMAGE029
为最小值的一个
Figure 82600DEST_PATH_IMAGE030
。
5.如权利要求4所述的一种温度控制的机器人打磨方法，其特征在于，根据公式
Figure 503217DEST_PATH_IMAGE032
计算所述机器人的当前关节角加速度的更新率
Figure 913470DEST_PATH_IMAGE033
；其中，
Figure 761340DEST_PATH_IMAGE034
为辅助变量，
Figure 686571DEST_PATH_IMAGE035
为
Figure 910879DEST_PATH_IMAGE036
的导数，
Figure 237955DEST_PATH_IMAGE037
为辅助变量
Figure 522306DEST_PATH_IMAGE038
的更新率，
Figure 121784DEST_PATH_IMAGE039
为所述机器人的当前关节角速度，
Figure 884203DEST_PATH_IMAGE040
为预设的内环控制器参数且
Figure 65786DEST_PATH_IMAGE041
,
Figure 521038DEST_PATH_IMAGE042
。
6.如权利要求5所述的一种温度控制的机器人打磨方法，其特征在于，根据所述更新率迭代更新所述机器人的期望关节角加速度的具体方法包括如下步骤：
计算当前时刻T的所述机器人的当前关节角加速度的更新率
Figure 420861DEST_PATH_IMAGE043
；
计算当前时刻T的所述辅助变量
Figure 986971DEST_PATH_IMAGE044
的更新率
Figure 960744DEST_PATH_IMAGE045
；
根据所述机器人的当前关节角加速度的更新率
Figure 586897DEST_PATH_IMAGE046
以及所述辅助变量
Figure 974016DEST_PATH_IMAGE038
的更新率
Figure 78238DEST_PATH_IMAGE047
获取迭代更新公式
Figure 234413DEST_PATH_IMAGE048
；
根据所述迭代更新公式对所述机器人的期望关节角加速度
Figure 31468DEST_PATH_IMAGE049
进行迭代更新。
7.如权利要求6所述的一种温度控制的机器人打磨方法，其特征在于，所述机器人的动力学模型的公式为
Figure 827254DEST_PATH_IMAGE050
，其中，
Figure 747DEST_PATH_IMAGE051
、
Figure 11428DEST_PATH_IMAGE052
、
Figure 979384DEST_PATH_IMAGE053
、
Figure 75516DEST_PATH_IMAGE054
分别为所述机器人的惯性矩阵、哥矢力与离心力矩阵、重力矩、摩擦力与扰动力矩，
Figure 459224DEST_PATH_IMAGE055
为所述机器人的控制力矩，
Figure 589991DEST_PATH_IMAGE056
为所述机器人的当前关节角度。
8.如权利要求7所述的一种温度控制的机器人打磨方法，其特征在于，所述机器人的动力学控制器的公式为
Figure 728848DEST_PATH_IMAGE057
，其中
Figure 312276DEST_PATH_IMAGE058
，
Figure 561992DEST_PATH_IMAGE059
、
Figure 547266DEST_PATH_IMAGE060
以及
Figure 43975DEST_PATH_IMAGE061
均为正常数，
Figure 114699DEST_PATH_IMAGE062
为所述机器人的期望关节角速度，
Figure DEST_PATH_IMAGE063
为所述机器人的期望关节角度。
9.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质存储有计算机程序，当所述计算机程序被处理器执行时实现如上述权利要求1至8任意一项所述的温度控制的机器人打磨方法。
CN202110200123.XA 2021-02-23 2021-02-23 一种温度控制的机器人打磨方法及计算机可读存储介质 Active CN112558486B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110200123.XA CN112558486B (zh) 2021-02-23 2021-02-23 一种温度控制的机器人打磨方法及计算机可读存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110200123.XA CN112558486B (zh) 2021-02-23 2021-02-23 一种温度控制的机器人打磨方法及计算机可读存储介质

Publications (2)

Publication Number Publication Date
CN112558486A true CN112558486A (zh) 2021-03-26
CN112558486B CN112558486B (zh) 2021-06-01

Family

ID=75034577

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110200123.XA Active CN112558486B (zh) 2021-02-23 2021-02-23 一种温度控制的机器人打磨方法及计算机可读存储介质

Country Status (1)

Country Link
CN (1) CN112558486B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113305839A (zh) * 2021-05-26 2021-08-27 深圳市优必选科技股份有限公司 机器人的导纳控制方法、导纳控制系统和机器人
CN113910240A (zh) * 2021-11-10 2022-01-11 上海景吾智能科技有限公司 实时调整机器人速度的力控打磨方法及系统

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4828451A (en) * 1986-08-07 1989-05-09 Daikin Industries, Ltd. Industrial robot
CN105242533A (zh) * 2015-09-01 2016-01-13 西北工业大学 一种融合多信息的变导纳遥操作控制方法
CN107932505A (zh) * 2017-11-15 2018-04-20 广东工业大学 基于关节臂机器人的最优打磨任务路径规划方法和装置
CN109620415A (zh) * 2019-02-14 2019-04-16 北京水木天蓬医疗技术有限公司 机器人辅助超声骨动力系统
CN109806106A (zh) * 2019-02-01 2019-05-28 中山大学 一种基于鲁棒控制与导纳控制结合的下肢康复机器人的控制方法
CN110561237A (zh) * 2019-10-08 2019-12-13 华中科技大学 一种结合主被动力控制的机器人砂带磨削方法及系统
CN111660306A (zh) * 2020-05-27 2020-09-15 华中科技大学 一种基于操作者舒适度的机器人可变导纳控制方法及系统
CN212217961U (zh) * 2020-04-17 2020-12-25 河南金桥白鸽砂轮制造有限公司 一种高效率的打磨机

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4828451A (en) * 1986-08-07 1989-05-09 Daikin Industries, Ltd. Industrial robot
CN105242533A (zh) * 2015-09-01 2016-01-13 西北工业大学 一种融合多信息的变导纳遥操作控制方法
CN107932505A (zh) * 2017-11-15 2018-04-20 广东工业大学 基于关节臂机器人的最优打磨任务路径规划方法和装置
CN109806106A (zh) * 2019-02-01 2019-05-28 中山大学 一种基于鲁棒控制与导纳控制结合的下肢康复机器人的控制方法
CN109620415A (zh) * 2019-02-14 2019-04-16 北京水木天蓬医疗技术有限公司 机器人辅助超声骨动力系统
CN110561237A (zh) * 2019-10-08 2019-12-13 华中科技大学 一种结合主被动力控制的机器人砂带磨削方法及系统
CN212217961U (zh) * 2020-04-17 2020-12-25 河南金桥白鸽砂轮制造有限公司 一种高效率的打磨机
CN111660306A (zh) * 2020-05-27 2020-09-15 华中科技大学 一种基于操作者舒适度的机器人可变导纳控制方法及系统

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113305839A (zh) * 2021-05-26 2021-08-27 深圳市优必选科技股份有限公司 机器人的导纳控制方法、导纳控制系统和机器人
CN113910240A (zh) * 2021-11-10 2022-01-11 上海景吾智能科技有限公司 实时调整机器人速度的力控打磨方法及系统

Also Published As

Publication number Publication date
CN112558486B (zh) 2021-06-01

Similar Documents

Publication Publication Date Title
CN112558486B (zh) 一种温度控制的机器人打磨方法及计算机可读存储介质
US9346164B1 (en) Programming and execution of force-based tasks with torque-controlled robot arms
US9156164B2 (en) Method for adjusting parameters of impedance control
CN108628172B (zh) 一种基于扩张状态观测器的机械臂高精度运动控制方法
CN110315396B (zh) 一种基于大数据的工业机器人恒力磨抛方法
CN102785166B (zh) 一种基于运动学变换的数控砂轮磨削加工方法
JP3124519B2 (ja) 制御系のモード切替え機能を有するロボット制御装置
CN111975579B (zh) 一种基于打磨模型和迭代算法的机器人恒力打磨系统
CN109290855B (zh) 一种工业机器人打磨过程中动态监测砂轮损耗的补偿方法
CN112676925A (zh) 航空发动机叶片磨抛方法、装置、设备及存储介质
CN111438635A (zh) 一种提高自由曲面打磨表面均匀性的方法
CN113156819A (zh) 协调打磨机械臂系统自适应神经网络同步阻抗控制方法
CN111975545A (zh) 基于反求控制点算法的复杂曲面工件打磨轨迹生成方法
CN111823100A (zh) 一种基于机器人的小曲率抛光打磨方法
CN103764344A (zh) 一种通过锻造来制造零件的方法
CN114660940A (zh) 一种基于深度强化学习ppo算法的磨削恒力控制方法
CN111085902A (zh) 一种视觉在线检测及修正的工件打磨系统
JP2007066001A (ja) ロボットの制御装置
CN117331309A (zh) 一种基于超扭曲滑模自适应导纳控制的机器人抛光方法
CN117620782A (zh) 一种复杂曲面的机器人自适应磨抛加工方法及系统
CN114952852A (zh) 机器人nurbs曲线速度规划方法、设备及存储介质
CN114670177B (zh) 一种两转一移并联机器人姿态规划方法
CN114131605B (zh) 一种船体零件打磨轨迹自动配准调整装置及方法
CN116533227A (zh) 一种基于示教轨迹优化与修正的机器人打磨系统的打磨方法
JP6343938B2 (ja) ロボット、制御装置、ロボットシステム及び制御方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant