CN112571411B - 用于电视机智能生产线的两用机械臂 - Google Patents
用于电视机智能生产线的两用机械臂 Download PDFInfo
- Publication number
- CN112571411B CN112571411B CN201910941876.9A CN201910941876A CN112571411B CN 112571411 B CN112571411 B CN 112571411B CN 201910941876 A CN201910941876 A CN 201910941876A CN 112571411 B CN112571411 B CN 112571411B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- moment
- joint
- arm
- production line
- 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
- 238000004519 manufacturing process Methods 0.000 title claims abstract description 18
- 238000000034 method Methods 0.000 claims abstract description 19
- 230000033001 locomotion Effects 0.000 claims abstract description 16
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 4
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 238000005381 potential energy Methods 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 10
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 239000002245 particle Substances 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000005265 energy consumption Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 238000005520 cutting process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000011664 nicotinic acid Substances 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种用于电视机智能生产线的两用机械臂,包括:标定单元,用于通过实测或者参数标定的方法标定电视机智能生产线的机械臂的尺寸参数、动力学参数以及关节的控制系统参数;指定信息输入单元,用于在所述控制系统中,通过输入指定所述机械臂的希望运动轨迹和速度;力矩计算单元,用于通过所述机械臂的运动算法求解各个关节所受的力矩;轨迹计算单元,用于计算各个关节的校正命令轨迹;指令单元,用于以计算出的校正命令来指示所述机械臂的运动。
Description
技术领域
本发明属于控制领域,具体涉及一种用于电视机智能生产线的两用机械臂。
背景技术
电视机智能生产线的工业机器人是一种基于多种传感器实现智能化、自动控制、可重复编程、仿人操作的机电一体化自动化生产设备,其最主要的部件是电视机智能生产线的机械臂,即本发明中所称的机械臂。这种机械臂是一种仿生机电设备,能模拟人手动作通过改变目标物体的位姿来实现作业。可完成搬运、焊接、切割、喷涂及装配等工作。工业机器人机械臂操作可控,可实现人机交互,用途非常广泛。由于工业机器人机械臂的结构特点,整体架构属于费力杠杆形式,并且传动齿轮间隙的存在也会降低机械臂的刚度及运动精度。同时,随着工业机器人需求数量不断增长,电视机智能生产线的机械臂控制方法也越来越复杂,在整个生产链中,其所消耗的能量也随之不断增长。目前,因此提高机械手臂的负载能力、提高整体控制复杂度的同时,如何能在高效控制的同时,降低能源消耗,成为最迫切的问题。
通常人们是通过减少控制电机电枢电阻和传动环节的摩擦来降低系统功能能耗,但从工业机器人高效利用电能的角度出发,在做出这些改进的同时,进一步分析改进控制方法和原理,实现对机械臂关节驱动系统能耗的主动高效控制,具有十分重要的意义。
发明内容
本发明的目的在于解决上述现有方法中存在的问题,通过计算机器人机械臂控制中所涉及到的能源消耗,同时建立机械臂的力学控制模型,再对其进行插值运算,用最终计算得到的校正命令轨迹代替平常的命令轨迹,输入到工业机器人机械臂控制系统的输入端,从而保证工业机器人机械臂末端准确地按照设定的希望轨迹运动。
本发明是通过以下技术方案实现的:
本发明的用于电视机智能生产线的两用机械臂,包括:
标定单元,用于通过实测或者参数标定的方法标定电视机智能生产线的机械臂的尺寸参数、动力学参数以及关节的控制系统参数;
指定信息输入单元,用于在所述控制系统中,通过输入指定所述机械臂的希望运动轨迹和速度;
力矩计算单元,用于通过所述机械臂的运动算法求解各个关节所受的力矩;
轨迹计算单元,用于计算各个关节的校正命令轨迹;
指令单元,用于以计算出的校正命令来指示所述机械臂的运动。
进一步地,在所述标定单元中,还包括:
力学模型建立子单元,用于根据系统参数建立控制电机控制机械臂的力学模型为:
其中τ(t)为机械臂的力矩,θL为机械臂轴的角度位移,为命令角度位移,A,B,C,E为机械臂第j关节控制系统本身的固有特性参数,可以表示为:
其中,Re控制电机电枢阻值,Jeff为控制电机有效惯性矩,Ke、Kv、Kp、Kb分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈。
进一步地,所述力矩计算单元中,各个关节所受的力矩τj为:
其中,L是Lagrange函数,其为机械臂总动能和总势能的差值,τj是机械臂第j关节的力矩,qj是机械臂连杆j的关节变量;而是关节变量qj对时间的一阶导数,n表示机械臂的关节数量。
首先来计算机械臂的动能,若机械臂连杆j上位置向量jr的质点质量为dm,则该质点的动能为:
则连杆j的动能Kj为:
其中,jr是质点在坐标系{j}中向量,Tj是基坐标系到连杆坐标系j的变换矩阵,Trace是求矩阵的迹。
机械臂的总动能为:
接着,计算机械臂的势能,连杆j的势能Pj为:
其中,mj为连杆j的质量,gT为重力加速度向量,即gT=[gx gy gz 0]。
则总势能为:
进一步地,在步骤(4)中,计算各个关节的校正命令轨迹具体包括:
假定系统在时间区间[0,t]是稳定的,在起始条件
之下,对机械臂的第j个驱动关节,计算上述力学模型,可以得到校正命令轨迹为:
设采样周期T,采样时间tk=k(k=0,1,…N,N为采样点数),τj(t)进行等间距采样,并在每个区间[tk,tk+1]进行三次插值运算,可以得到:
其中,mK由下式确定:
其中,n=N,而λk由采样值序列确定。
由上面的计算可以得到校正命令轨迹
进一步地,在所述指令单元利用得到的校正命令轨迹来输入控制电机中,以使该命令轨迹控制机械臂的运动。
附图说明
图1为本发明的用于电视机智能生产线的两用机械臂。
具体实施方式
下面结合附图对本发明作优选详细描述:
参见图1,用于电视机智能生产线的两用机械臂包括:
标定单元,用于通过实测或者参数标定的方法标定电视机智能生产线的机械臂的尺寸参数、动力学参数以及关节的控制系统参数;
指定信息输入单元,用于在所述控制系统中,通过输入指定所述机械臂的希望运动轨迹和速度;
力矩计算单元,用于通过所述机械臂的运动算法求解各个关节所受的力矩;
轨迹计算单元,用于计算各个关节的校正命令轨迹;
指令单元,用于以计算出的校正命令来指示所述机械臂的运动。
优选地,在所述标定单元中,还包括:
力学模型建立子单元,用于根据系统参数建立控制电机控制机械臂的力学模型为:
其中τ(t)为机械臂的力矩,θL为机械臂轴的角度位移,为命令角度位移,A,B,C,E为机械臂第j关节控制系统本身的固有特性参数,可以表示为:
其中,Re控制电机电枢阻值,Jeff为控制电机有效惯性矩,Ke、Kv、Kp、Kb分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈。
优选地,所述力矩计算单元中,各个关节所受的力矩τj为:
其中,L是Lagrange函数,其为机械臂总动能和总势能的差值,τj是机械臂第j关节的力矩,qj是机械臂连杆j的关节变量;而是关节变量qj对时间的一阶导数,n表示机械臂的关节数量。
首先来计算机械臂的动能,若机械臂连杆j上位置向量jr的质点质量为dm,则该质点的动能为:
则连杆j的动能Kj为:
其中,jr是质点在坐标系{j}中向量,Tj是基坐标系到连杆坐标系j的变换矩阵,Trace是求矩阵的迹。
机械臂的总动能为:
接着,计算机械臂的势能,连杆j的势能Pj为:
其中,mj为连杆j的质量,gT为重力加速度向量,即gT=[gx gy gz 0]。
则总势能为:
优选地,在步骤(4)中,计算各个关节的校正命令轨迹具体包括:
假定系统在时间区间[0,t]是稳定的,在起始条件
之下,对机械臂的第j个驱动关节,计算上述力学模型,可以得到校正命令轨迹为:
设采样周期T,采样时间tk=k(k=0,1,…N,N为采样点数),对τj(t)进行等间距采样,并在每个区间[tk,tk+1]进行三次插值运算,可以得到:
其中,mK由下式确定:
其中,n=N,而λk由采样值序列确定。
由上面的计算可以得到校正命令轨迹
优选地,在所述指令单元利用得到的校正命令轨迹来输入控制电机中,以使该命令轨迹控制机械臂的运动。
上述技术方案只是本发明的一种实施方式,对于本领域内的技术人员而言,在本发明公开了应用方法和原理的基础上,很容易做出各种类型的改进或变形,而不仅限于本发明上述具体实施方式所描述的方法,因此前面描述的方式只是优选的,而并不具有限制性的意义。
Claims (2)
1.一种用于电视机智能生产线的两用机械臂,包括:
标定单元,用于通过实测或者参数标定的方法标定电视机智能生产线的机械臂的尺寸参数、动力学参数以及关节的控制系统参数;
指定信息输入单元,用于在所述控制系统中,通过输入指定所述机械臂的希望运动轨迹和速度;
力矩计算单元,用于通过所述机械臂的运动算法求解各个关节所受的力矩;
轨迹计算单元,用于计算各个关节的校正命令轨迹;
指令单元,用于以计算出的校正命令来指示所述机械臂的运动;
其中在标定单元中,具体包括:
力学模型建立子单元,用于根据系统参数建立控制电机控制所述机械臂的力学模型为:
其中τ(t)为机械臂的力矩,θL为机械臂轴的角度位移,为命令角度位移,A,B,C,E为机械臂第j关节控制系统本身的固有特性参数,可以表示为:
其中,Re控制电机电枢阻值,Jeff为控制电机有效惯性矩,Ke、Kv、Kp、Kb分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈;
其中所述力矩计算单元中,各个关节所受的力矩τj为:
其中,L是Lagrange函数,其为机械臂总动能和总势能的差值,τj是机械臂第j关节的力矩,qj是机械臂连杆j的关节变量;而是关节变量qj对时间的一阶导数,n表示机械臂的关节数量;
首先来计算机械臂的动能:若机械臂连杆j上位置向量jr的质点质量为dm,则该质点的动能为:
则连杆j的动能Kj为:
其中,jr是质点在坐标系{j}中向量,Tj是基坐标系到连杆坐标系j的变换矩阵,Trace是求矩阵的迹;
机械臂的总动能为:
接着,计算机械臂的势能,连杆j的势能Pj为:
其中,mj为连杆j的质量,gT为重力加速度向量,即gT=[gx gy gz 0];
则总势能为:
进一步地,计算各个关节的校正命令轨迹具体包括:
假定系统在时间区间[0,t]是稳定的,在起始条件
之下,对机械臂的第j个驱动关节,计算上述力学模型,可以得到校正命令轨迹为:
设采样周期T,采样时间tk=k(k=0,1,…N,N为采样点数),对τj(t)进行等间距采样,并在每个区间[tk,tk+1]进行三次插值运算,可以得到:
其中,mK由下式确定:
其中,n=N,而λk由采样值序列确定;
由上面的计算可以得到校正命令轨迹
2.根据权利要求1所述的用于电视机智能生产线的两用机械臂,其中所述指令单元利用得到的校正命令轨迹来输入控制电机中,以使该命令轨迹控制机械臂的运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910941876.9A CN112571411B (zh) | 2019-09-30 | 2019-09-30 | 用于电视机智能生产线的两用机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910941876.9A CN112571411B (zh) | 2019-09-30 | 2019-09-30 | 用于电视机智能生产线的两用机械臂 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112571411A CN112571411A (zh) | 2021-03-30 |
CN112571411B true CN112571411B (zh) | 2024-03-26 |
Family
ID=75116408
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910941876.9A Active CN112571411B (zh) | 2019-09-30 | 2019-09-30 | 用于电视机智能生产线的两用机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112571411B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112571412B (zh) * | 2019-09-30 | 2024-03-26 | 中电九天智能科技有限公司 | 一种智能制造设备的控制系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001001282A (ja) * | 1999-06-16 | 2001-01-09 | Kawasaki Heavy Ind Ltd | ロボットアームのたわみ補正装置 |
JP2010058256A (ja) * | 2008-09-08 | 2010-03-18 | Yaskawa Electric Corp | アーム位置調整方法及び装置並びにロボットシステム |
JP2011212823A (ja) * | 2010-04-02 | 2011-10-27 | Yaskawa Electric Corp | ロボットアーム位置補正パラメータの同定装置及び方法、並びにそれを用いたロボットコントローラ及びロボット制御方法 |
JP2015089584A (ja) * | 2013-11-05 | 2015-05-11 | トヨタ自動車株式会社 | ロボットの制御方法及びロボットシステム |
CN107457783A (zh) * | 2017-07-25 | 2017-12-12 | 电子科技大学 | 基于pd控制器的六自由度机械臂自适应智能检测方法 |
CN108621157A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 基于模型约束的机械臂能量最优轨迹规划控制方法及装置 |
CN110026981A (zh) * | 2019-04-19 | 2019-07-19 | 中科新松有限公司 | 一种基于模型自适应的机械臂碰撞检测方法 |
-
2019
- 2019-09-30 CN CN201910941876.9A patent/CN112571411B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001001282A (ja) * | 1999-06-16 | 2001-01-09 | Kawasaki Heavy Ind Ltd | ロボットアームのたわみ補正装置 |
JP2010058256A (ja) * | 2008-09-08 | 2010-03-18 | Yaskawa Electric Corp | アーム位置調整方法及び装置並びにロボットシステム |
JP2011212823A (ja) * | 2010-04-02 | 2011-10-27 | Yaskawa Electric Corp | ロボットアーム位置補正パラメータの同定装置及び方法、並びにそれを用いたロボットコントローラ及びロボット制御方法 |
JP2015089584A (ja) * | 2013-11-05 | 2015-05-11 | トヨタ自動車株式会社 | ロボットの制御方法及びロボットシステム |
CN107457783A (zh) * | 2017-07-25 | 2017-12-12 | 电子科技大学 | 基于pd控制器的六自由度机械臂自适应智能检测方法 |
CN108621157A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 基于模型约束的机械臂能量最优轨迹规划控制方法及装置 |
CN110026981A (zh) * | 2019-04-19 | 2019-07-19 | 中科新松有限公司 | 一种基于模型自适应的机械臂碰撞检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112571411A (zh) | 2021-03-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110561440B (zh) | 一种冗余度机械臂加速度层多目标规划方法 | |
CN105773623B (zh) | 基于预测型间接迭代学习的scara机器人轨迹跟踪控制方法 | |
CN106475999B (zh) | 刚性条件下基于阻抗模型的双臂协调的加速度控制方法 | |
CN113681543B (zh) | 一种基于模型预测的机械臂零力控制方法 | |
CN109514602A (zh) | 一种基于负载自适应辨识的工业机器人力矩补偿控制方法 | |
CN110154024B (zh) | 一种基于长短期记忆神经网络增量模型的装配控制方法 | |
CN107972030B (zh) | 一种冗余机械臂重复运动中的初始位置修正方法 | |
CN106041932B (zh) | 一种ur机器人的运动控制方法 | |
CN111687827B (zh) | 一种双机器人协调操作弱刚性构件的控制方法和控制系统 | |
CN109352656B (zh) | 一种具有时变输出约束的多关节机械臂控制方法 | |
CN110861090B (zh) | 一种力矩前馈控制系统及方法 | |
CN110587611B (zh) | 电视机组装线的机械臂控制方法 | |
CN111230882A (zh) | 一种水果分拣并联机器人夹持机构的自适应变阻抗控制方法 | |
CN108098777B (zh) | 一种冗余度机械臂力矩层重复运动控制方法 | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
CN110695994B (zh) | 一种面向双臂机械手协同重复运动的有限时间规划方法 | |
CN112571411B (zh) | 用于电视机智能生产线的两用机械臂 | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
CN112571412B (zh) | 一种智能制造设备的控制系统 | |
CN110774286B (zh) | 一种基于刚柔耦合动力学的五自由度机械手的控制方法 | |
CN113664830B (zh) | 基于模型预测阻抗控制的双机器人同步加工方法及系统 | |
Nuritdinovich et al. | The concept of the mathematical description of the multi-coordinate mechatronic module of the robot | |
CN114740735A (zh) | 单关节机器人的变长度反馈辅助pd型迭代学习控制方法 | |
US20230035296A1 (en) | Method of suppressing vibrations of a robot arm with external objects | |
Duan et al. | Welding trajectory planning of beam welding robot based on computer simulation |
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 |