CN113021331B - 一种七自由度协作机器人动力学建模与辨识方法 - Google Patents
一种七自由度协作机器人动力学建模与辨识方法 Download PDFInfo
- Publication number
- CN113021331B CN113021331B CN201911347082.6A CN201911347082A CN113021331B CN 113021331 B CN113021331 B CN 113021331B CN 201911347082 A CN201911347082 A CN 201911347082A CN 113021331 B CN113021331 B CN 113021331B
- Authority
- CN
- China
- Prior art keywords
- joint
- parameters
- model
- robot
- body part
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种七自由度协作机器人动力学建模与辨识方法,包括以下步骤:首先,将机器人动力学模型分解为多连杆刚体和关节柔体两部分,分别进行建模。然后,用关节扭矩传感器测量数据和数值拟合方法对刚体部分进行参数辨识,采用频域分析方法对关节柔体部分进行参数辨识。最后,将刚体和柔体两部分模型与辨识参数组合成完整动力学模型。本发明考虑协作机器人的刚体和柔体混合特点,给出了建模与辨识方法。方法能够较准确描述为七自由度协作机器人动态特性。方法可应用于协作机器人高精度运动控制、力控制以及人机交互控制等,提高控制性能。
Description
技术领域
本发明涉及机器人领域,具体地说是一种七自由度协作机器人动力学建模与辨识方法,特别适用于机器人运动控制、力控制和人机交互控制等。
背景技术
协作机器人因具有轻质、大负载自重比、拟人构型等特点,被广泛应用于柔性化工业生产线、电子元器件装配、医疗与服务等多种行业。与传统六自由度机械臂相比,七自由度构型机器人具有更大、更灵活的工作空间,特别适合应用在与人交互工作环境中。
精确的动力学建模和辨识方法,是获得机器人动态特性的重要基础。依靠动力学模型信息,可以设计高精度运动控制和轨迹规划方法,使机器人具有高精度、高动态特性。传统工业机器人动力学建模与辨识方法,难以应用于七自由度协作机器人,主要难点在于:1)自由度数发生变化。传统六自由度工业机器人,给出指定构型,采用商用软件中成熟的建模与辨识方法,即可获得准确结果。对于七自由度的冗余构型,目前还没有成熟参考方法;2)刚度低,不能简化成纯刚体模型。协作机器人具有低刚度特性,特别是距离末端较远的关节采用谐波减速器设计方式。在高动态运动过程中,低刚度部分难免产生弹性形变。这样的柔体动态特性,难以采用纯刚体动力学模型来描述;3)摩擦与柔性耦合产生的复杂动态特性难以建模。在传统机器人动力学建模方法中,摩擦力动态建模是其中难点,很难用精确模型描述,通常简化成简单模型粗略描述。在协作七自由度机械臂中,摩擦与柔性的耦合更加复杂难以建模。本发明为解决以上难点,发明一种七自由度协作机器人动力学建模与辨识方法,方法可应用于七自由度协作机器人运动控制、力控制和人机交互控制等。
发明内容
针对现有技术的不足,本发明提出了一种七自由度协作机器人动力学建模与辨识方法。在该方法中,模型分解为多连杆刚体和关节柔体,依据关节扭矩传感器和运动状态进行刚体建模,依据频域分析方法进行关节柔性建模。进而综合辨识出机器人动力学模型。
本发明为实现上述目的所采用的技术方案是:一种七自由度协作机器人动力学建模与辨识方法,包括以下步骤:
步骤1:对机器人刚体部分建立动力学模型;
步骤2:对动力学模型进行参数线性化处理;
步骤3:对参数线性化处理后的动力学模型进行最小参数集处理;
步骤4:采用傅立叶级数型轨迹激发运动,机器人沿轨迹动作;
步骤5:对机器人运动中所采集的测量信号进行滤波处理;
步骤6:采用最小二乘方法进行动力学模型的参数辨识得到钢体部分的参数;
步骤7:根据辨识所得参数获得动力学模型并作为前馈控制输入;
步骤8:对机器人柔体部分进行建模;
步骤9:对前馈补偿后的各关节进行辨识,得到柔体部分的参数;
步骤10:根据辨识后得到的钢体部分参数和柔体部分参数,构建混合动力学模型。
步骤1中,所述动力学模型表述为如下形式:
步骤2中,对动力学模型进行参数线性化处理,得到如下形式:
其中,P=[p1,p2,...,p7]T,表示各个关节的参数集,且具有pi,i=1...7=[Ixxi,Iyyi,Izzi,Ixyi,Ixzi,Iyzi,Hxi,Hyi,Hzi,mi]T,Ixxi,Iyyi,Izzi,Ixyi,Ixzi,Iyzi分别表示第i个连杆绕x轴、绕y轴、绕z轴、绕xy轴、绕xz轴、绕yz轴的惯量参数,Hxi,Hyi,Hzi分别表示第i个连杆绕x轴、绕y轴、绕z轴的惯量与质量组合参数,mi为第i个连杆的质量参数;表示参数方程各变量的系数矩阵。
对步骤2所得到形式进行最小参数集处理,得到:
其中,WB为W独立的列组成的矩阵,PB为最小参数组成的列向量。
步骤4中的激发轨迹通过下式实现:
其中:qi表示第i个关节转角,qi0表示第i个关节转角常量,al、bl表示轨迹的常系数,ωf为轨迹的基频,ωfl表示第l阶的频率,l=1...N,N表示最大频率,t表示时刻。
步骤6通过下式得到参数:
PB为通过最小参数集处理得到的最小参数组成的列向量,WB为W独立的列组成的矩阵,τ为扭矩传感器测量的关节扭矩。
步骤8中,柔体部分模型如下:
K(θm-θl)=τe
其中,Jm和Jl分别表示电机端和负载端的转动惯量,Bm表示电机端的阻尼;τm表示电机转子提供的输入扭矩,τ表示传感器测量扭矩;θm和θl分别表示电机转角和负载转角,θl与q表示同一物理量,为关节负载端的位置,即q=[θ1,...θ7]T;
若关节不存在柔性则θm≡θl,若柔性存在使得由弹性元件之间扭转变形产生扭矩τe,弹性形变参数为刚度K。
步骤9中,对步骤7中进行前馈补偿后的各关节输入扫频信号,得到各单关节的频谱特性;经过多次激发,得到多组关节谐振频率ωr和反谐振频率ωa,根据下式辨识得到关节柔性的参数K和Jl:
其中,Jm和Jl分别表示电机端和负载端的转动惯量,K为刚度。
将步骤6和步骤9辨识得到参数分别带入刚体模型和柔体模型,即得到刚体部分和柔体部分的混合模型。
本发明具有以下有益效果及优点:
1.本发明提出的方法适用于具有七自由度冗余构型机器人;
2.本发明提出的方法直接利用扭矩传感器测量关节扭矩,能够提高测量与辨识精度;
3.本发明提出的方法对关节柔性进行建模,描述关节弹性形变引起动态特性,能够提高测量与辨识精度。
4.本发明提出的建模与辨识方法,可在线估计出期望关节扭矩,作为控制前馈输入,能够提高动态响应能力。
附图说明
图1为本发明的方法流程图;
图2为本发明中机器人的模型示意图;
图3为本发明实验结果图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
本发明首先将模型分解为多连杆刚体和关节柔体,分别建模和辨识,最后综合得到动力学参数,具体步骤如下(如图1):
步骤1:对机器人刚体部分进行建模。采用“牛顿-欧拉”迭代方法建立“关节扭矩传感器输入-机器人运动状态输出”刚体动力学模型,具有如下形式:
步骤2:对步骤1所得到动力学模型进行参数线性化处理,得到如下形式:
其中,P=[p1,p2,...,p7]T,表示各个关节的参数集,且具有pi,i=1...7=[Ixxi,Iyyi,Izzi,Ixyi,Ixzi,Iyzi,Hxi,Hyi,Hzi,mi]T,包含了惯量与质量参数。Ixxi,Iyyi,Izzi分别表示第i个连杆绕x轴、绕y轴、绕z轴的惯量参数,Ixyi,Ixzi,Iyzi分别表示第i个连杆绕x、y轴耦合的惯量参数,绕x、z轴耦合的惯量参数、绕y、z轴耦合的的惯量参数,Hxi,Hyi,Hzi分别表示第i个连杆绕x轴、绕y轴、绕z轴的惯量与质量组合参数。
步骤3:对步骤2所得到形式进行最小参数集处理,利用机器人几何参数直接推导最小惯性参数和QR分解方法获取最小参数,处理结果为:
其中,WB为W独立的列组成的矩阵,PB为最小参数组成的列向量。
步骤4:采用傅立叶级数型轨迹激发运动,轨迹如下形式:
其中:qi表示关节转角,qi0表示关节转角常量,al、bl表示轨迹的常系数,ωf为轨迹的基频,ωfl表示第l阶的频率,l=1...N。
步骤5:对测量信号进行滤波处理,采用零相位低通滤波对进行数据处理,可利用中值微分算法对角速度微分并进行RLOESS平滑滤波处理。对于扭矩传感器测量值τ,也采用RLOESS平滑滤波处理来去除噪声和纹波。
步骤6:采用最小二乘方法进行参数辨识,得到参数:
步骤7:获得动力学模型刚体部分并做前馈控制输入。将步骤6辨识得到参数,代入步骤1动力学模型中,得到机器人“关节扭矩传感器输入-机器人运动状态输出”刚体动力学模型,同时依据模型实时计算期望扭矩,作为前馈补偿到控制输入。
步骤8:对机器人刚体部分进行建模,将机器人每个关节建模为“双质量模型”,如图2所示,得到
K(θm-θl)=τe
其中,Jm和Jl分别表示电机端和负载端的转动惯量,Bm表示电机端的阻尼。τm表示电机转子提供的输入扭矩,τ表示传感器测量扭矩。θm和θl分别表示电机转角和负载转角,θl与前速步骤中q表示同一物理量,即q=[θ1,...θ7]T。若关节不存在柔性则θm≡θl,由于柔性存在,使得由弹性元件之间扭转变形产生扭矩τe,弹性形变参数为刚度K。模型中,除了关节柔性参数K、负载惯量Jl和,其余参数都已知。图2中θf=θl-θm表示负载端与电机端转角之差,即扭矩变形的角度。
步骤9:辨识柔体参数,对步骤7中进行前馈补偿的后的各关节输入扫频信号,得到各单关节的频谱特性。经过多次激发,得到多组谐振ωr和反谐振频率ωa,根据
辨识得到关节柔性的参数K和Jl。
步骤10:综合以上步骤6和步骤9中辨识得到参数,可建立如步骤1和步骤8混合动力学模型。其中,步骤6和步骤9分别辨识得到刚体部分和柔体部分的模型参数。最终模型,由步骤1中的刚体模型和步骤8中的柔体模型组合而成。
本发明的效果通过以下实验进一步说明。
应用这种方法在七自由度协作机械臂上进行实验验证,结果如图3所示,其中实线表示机器人实际关节扭矩,虚线表示采用辨识模型计算得到扭矩。对比发现:辨识得到模型可准确计算出关节扭矩,进而反映出机器人动态特性。
以上描述仅是本发明的具体实例,未构成对本发明的任何限制,显然对于本领域的专业人员来说,在了解了本发明内容和原理后,都可能在不背离本发明原理、结构的情况下,进行形式和细节上的各种修正和改变,但是这些基于本发明思想的修正和改变仍在本发明的权利要求保护范围之内。
Claims (7)
1.一种七自由度协作机器人动力学建模与辨识方法,其特征在于包括以下步骤:
步骤1:对机器人刚体部分建立动力学模型;
步骤2:对动力学模型进行参数线性化处理;
步骤3:对参数线性化处理后的动力学模型进行最小参数集处理;
步骤4:采用傅立叶级数型轨迹激发运动,机器人沿轨迹动作;
步骤5:对机器人运动中所采集的测量信号进行滤波处理;
步骤6:采用最小二乘方法进行动力学模型的参数辨识得到钢体部分的参数;
步骤7:根据辨识所得参数获得动力学模型并作为前馈控制输入;
步骤8:对机器人柔体部分进行建模;
步骤9:对前馈补偿后的各关节进行辨识,得到柔体部分的参数;
步骤10:根据辨识后得到的钢体部分参数和柔体部分参数,构建混合动力学模型;
步骤1中,所述动力学模型表述为如下形式:
步骤2中,对动力学模型进行参数线性化处理,得到如下形式:
其中,P=[p1,p2,…,p7]T,表示各个关节的参数集,且具有pi,i=1…7=[Ixxi,Iyyi,Izzi,Ixyi,Ixzi,Iyzi,Hxi,Hyi,Hzi,mi]T,Ixxi,Iyyi,Izzi,Ixyi,Ixzi,Iyzi分别表示第i个连杆绕x轴、绕y轴、绕z轴、绕xy轴、绕xz轴、绕yz轴的惯量参数,Hxi,Hyi,Hzi分别表示第i个连杆绕x轴、绕y轴、绕z轴的惯量与质量组合参数,mi为第i个连杆的质量参数;表示参数方程各变量的系数矩阵;
步骤8中,柔体部分模型如下:
K(θm-θl)=τe
其中,Jm和Jl分别表示电机端和负载端的转动惯量,Bm表示电机端的阻尼;τm表示电机转子提供的输入扭矩,τ表示传感器测量扭矩;θm和θl分别表示电机转角和负载转角,θl与q表示同一物理量,为关节负载端的位置,即q=[θ1,…θ7]T;
若关节不存在柔性则θm≡θl,若柔性存在使得由弹性元件之间扭转变形产生扭矩τe,弹性形变参数为刚度K;
步骤9中,对步骤7中进行前馈补偿后的各关节输入扫频信号,得到各单关节的频谱特性;经过多次激发,得到多组关节谐振频率ωr和反谐振频率ωa,根据下式辨识得到关节柔性的参数K和Jl:
其中,Jm和Jl分别表示电机端和负载端的转动惯量,K为刚度。
7.根据权利要求1所述的一种七自由度协作机器人动力学建模与辨识方法,其特征在于:将步骤6和步骤9辨识得到参数分别带入刚体模型和柔体模型,即得到刚体部分和柔体部分的混合模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911347082.6A CN113021331B (zh) | 2019-12-24 | 2019-12-24 | 一种七自由度协作机器人动力学建模与辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911347082.6A CN113021331B (zh) | 2019-12-24 | 2019-12-24 | 一种七自由度协作机器人动力学建模与辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113021331A CN113021331A (zh) | 2021-06-25 |
CN113021331B true CN113021331B (zh) | 2022-04-05 |
Family
ID=76451617
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911347082.6A Active CN113021331B (zh) | 2019-12-24 | 2019-12-24 | 一种七自由度协作机器人动力学建模与辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113021331B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113910238B (zh) * | 2021-11-06 | 2023-05-30 | 中国船舶集团有限公司第七一六研究所 | 机器人刚度建模、辨识与修正方法及实验*** |
CN114700939B (zh) * | 2022-03-04 | 2024-02-06 | 华中科技大学 | 一种协作机器人关节负载转矩观测方法、***及存储介质 |
CN114619451B (zh) * | 2022-03-31 | 2023-12-05 | 西安交通大学 | 串联工业机器人的机电控感耦合建模方法 |
CN114888803B (zh) * | 2022-05-19 | 2024-01-30 | 山东新一代信息产业技术研究院有限公司 | 一种基于迭代优化的机械臂动力学参数辨识方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104608127A (zh) * | 2013-11-05 | 2015-05-13 | 库卡实验仪器有限公司 | 对冗余的工业机器人的运动过程的编程方法和工业机器人 |
CN107498562A (zh) * | 2017-04-21 | 2017-12-22 | 浙江工业大学 | 六自由度机械臂动力学模型辨识方法 |
CN108319144A (zh) * | 2018-02-21 | 2018-07-24 | 湘潭大学 | 一种机器人轨迹跟踪控制方法及*** |
CN108549738A (zh) * | 2018-03-01 | 2018-09-18 | 清华大学深圳研究生院 | 一种伸长型气动肌肉及其动力学建模方法 |
CN108714896A (zh) * | 2018-05-28 | 2018-10-30 | 华南理工大学 | 一种基于柔体动力学模型的机器人柔性力矩前馈控制方法 |
CN109291046A (zh) * | 2017-07-25 | 2019-02-01 | 中国科学院沈阳自动化研究所 | 一种七自由度拟人构型机械臂逆运动学规划方法 |
EP3436876A2 (en) * | 2016-03-29 | 2019-02-06 | Cognibotics AB | Method, constraining device and system for determining geometric properties of a manipulator |
CN109397244A (zh) * | 2018-11-23 | 2019-03-01 | 华中科技大学 | 一种一体化双7自由度机械臂全向移动机器人***与控制方法 |
CN109583093A (zh) * | 2018-11-30 | 2019-04-05 | 山东大学 | 一种考虑关节弹性的工业机器人动力学参数辨识方法 |
CN109591018A (zh) * | 2019-01-07 | 2019-04-09 | 北京邮电大学 | 一种用于目标捕获后稳定的自由漂浮空间机械臂控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006117022A1 (en) * | 2005-05-02 | 2006-11-09 | Abb Research Ltd | A method for control of an industrial robot |
KR102189666B1 (ko) * | 2012-08-15 | 2020-12-11 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 기계 몸체의 운동을 조종하기 위한 가상 자유도 |
-
2019
- 2019-12-24 CN CN201911347082.6A patent/CN113021331B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104608127A (zh) * | 2013-11-05 | 2015-05-13 | 库卡实验仪器有限公司 | 对冗余的工业机器人的运动过程的编程方法和工业机器人 |
EP3436876A2 (en) * | 2016-03-29 | 2019-02-06 | Cognibotics AB | Method, constraining device and system for determining geometric properties of a manipulator |
CN107498562A (zh) * | 2017-04-21 | 2017-12-22 | 浙江工业大学 | 六自由度机械臂动力学模型辨识方法 |
CN109291046A (zh) * | 2017-07-25 | 2019-02-01 | 中国科学院沈阳自动化研究所 | 一种七自由度拟人构型机械臂逆运动学规划方法 |
CN108319144A (zh) * | 2018-02-21 | 2018-07-24 | 湘潭大学 | 一种机器人轨迹跟踪控制方法及*** |
CN108549738A (zh) * | 2018-03-01 | 2018-09-18 | 清华大学深圳研究生院 | 一种伸长型气动肌肉及其动力学建模方法 |
CN108714896A (zh) * | 2018-05-28 | 2018-10-30 | 华南理工大学 | 一种基于柔体动力学模型的机器人柔性力矩前馈控制方法 |
CN109397244A (zh) * | 2018-11-23 | 2019-03-01 | 华中科技大学 | 一种一体化双7自由度机械臂全向移动机器人***与控制方法 |
CN109583093A (zh) * | 2018-11-30 | 2019-04-05 | 山东大学 | 一种考虑关节弹性的工业机器人动力学参数辨识方法 |
CN109591018A (zh) * | 2019-01-07 | 2019-04-09 | 北京邮电大学 | 一种用于目标捕获后稳定的自由漂浮空间机械臂控制方法 |
Non-Patent Citations (1)
Title |
---|
七自由度机械臂动力学建模与轨迹规划研究;宋少华;《CNKI》;20150701;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113021331A (zh) | 2021-06-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113021331B (zh) | 一种七自由度协作机器人动力学建模与辨识方法 | |
CN109514602B (zh) | 一种基于负载自适应辨识的工业机器人力矩补偿控制方法 | |
CN108227492B (zh) | 一种六自由度串联机器人末端负载动力学参数的辨识方法 | |
Huynh et al. | Modelling the dynamics of industrial robots for milling operations | |
CN108714896B (zh) | 一种基于柔体动力学模型的机器人柔性力矩前馈控制方法 | |
CN110539302B (zh) | 一种工业机器人整体动力学建模及动力学参数辨识方法 | |
CN107703747B (zh) | 一种面向搅拌摩擦焊应用的重载机器人动力学参数自标定方法 | |
CN109249397B (zh) | 一种六自由度机器人动力学参数辨识方法和*** | |
Cui et al. | Dynamic modeling and vibration prediction of an industrial robot in manufacturing | |
CN110941183B (zh) | 一种基于神经网络的工业机器人动力学辨识方法 | |
CN110962124B (zh) | 切削加工机器人静态误差补偿与动刚度模型的修正方法 | |
CN103568013A (zh) | 机器人的控制装置、控制方法以及机器人 | |
JP5932578B2 (ja) | 振動抑制方法、振動抑制装置および振動抑制機能を備えた産業用機械装置 | |
CN109397265A (zh) | 一种基于动力学模型的关节型工业机器人拖拽示教方法 | |
CN109634111B (zh) | 一种高速重载机器人动态变形计算方法 | |
CN110065073B (zh) | 一种机器人动力学模型辨识方法 | |
JPH05277976A (ja) | 動力学モデルパラメータ同定装置 | |
Wang et al. | Dynamic performance analysis of parallel manipulators based on two-inertia-system | |
CN114169230A (zh) | 一种机器人动力学参数的辨识方法 | |
CN112179551B (zh) | 机器人的关节电机转矩系数与摩擦力同步测试方法和装置 | |
CN114952858A (zh) | 一种基于摩擦补偿控制的工业机器人轨迹跟踪方法和*** | |
CN112975987A (zh) | 一种基于动力学模型的骨科手术机器人控制方法 | |
CN111783248A (zh) | 一种工业机器人动力学建模及动力学参数识别方法 | |
JP3081518B2 (ja) | ロボットの剛性同定方法及びその装置 | |
CN112231888B (zh) | 一种基于激光追踪测量***机械结构的理想动力学模型建立方法 |
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 |