CN112571412B - 一种智能制造设备的控制系统 - Google Patents

一种智能制造设备的控制系统 Download PDF

Info

Publication number
CN112571412B
CN112571412B CN201910941879.2A CN201910941879A CN112571412B CN 112571412 B CN112571412 B CN 112571412B CN 201910941879 A CN201910941879 A CN 201910941879A CN 112571412 B CN112571412 B CN 112571412B
Authority
CN
China
Prior art keywords
mechanical arm
moment
unit
manufacturing equipment
intelligent manufacturing
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
Application number
CN201910941879.2A
Other languages
English (en)
Other versions
CN112571412A (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.)
Cec Jiutian Intelligent Technology Co ltd
Original Assignee
Cec Jiutian Intelligent Technology 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 Cec Jiutian Intelligent Technology Co ltd filed Critical Cec Jiutian Intelligent Technology Co ltd
Priority to CN201910941879.2A priority Critical patent/CN112571412B/zh
Publication of CN112571412A publication Critical patent/CN112571412A/zh
Application granted granted Critical
Publication of CN112571412B publication Critical patent/CN112571412B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Feedback Control In General (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为本发明的智能制造设备的控制系统。
图2为用于智能制造设备的两用机械臂控制单元。
具体实施方式
下面结合附图对本发明作优选详细描述:
参见图1智能制造设备的控制系统,包括电源单元和用于智能制造设备的两用机械臂控制单元,所述电源单元为所述用于智能制造设备的两用机械臂控制单元提供电力。
优选地,参见图2,所述用于智能制造设备的两用机械臂控制单元包括:
标定单元,用于通过实测或者参数标定的方法标定智能制造设备的机械臂的尺寸参数、动力学参数以及关节的控制系统参数;
指定信息输入单元,用于在所述控制系统中,通过输入指定所述机械臂的希望运动轨迹和速度;
力矩计算单元,用于通过所述机械臂的运动算法求解各个关节所受的力矩;
轨迹计算单元,用于计算各个关节的校正命令轨迹;
指令单元,用于以计算出的校正命令来指示所述机械臂的运动。
优选地,在所述标定单元中,还包括:
力学模型建立子单元,用于根据系统参数建立控制电机控制机械臂的力学模型为:
其中τ(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 (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];
则总势能为:
进一步地,计算各个关节的校正命令轨迹具体包括:
假定系统在时间区间[0,t]是稳定的,在起始条件
之下,对机械臂的第j个驱动关节,计算上述力学模型,可以得到校正命令轨迹为:
设采样周期T,采样时间tk=k(k=0,1,…N,N为采样点数),对τj(t)进行等间距采样,并在每个区间[tk,tk+1]进行三次插值运算,可以得到:
其中,mK由下式确定:
其中,n=N,而λk由采样值序列确定;
由上面的计算可以得到校正命令轨迹
所述指令单元利用得到的校正命令轨迹来输入控制电机中,以使该命令轨迹控制机械臂的运动。
CN201910941879.2A 2019-09-30 2019-09-30 一种智能制造设备的控制系统 Active CN112571412B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910941879.2A CN112571412B (zh) 2019-09-30 2019-09-30 一种智能制造设备的控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910941879.2A CN112571412B (zh) 2019-09-30 2019-09-30 一种智能制造设备的控制系统

Publications (2)

Publication Number Publication Date
CN112571412A CN112571412A (zh) 2021-03-30
CN112571412B true CN112571412B (zh) 2024-03-26

Family

ID=75116395

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910941879.2A Active CN112571412B (zh) 2019-09-30 2019-09-30 一种智能制造设备的控制系统

Country Status (1)

Country Link
CN (1) CN112571412B (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11134012A (ja) * 1997-10-24 1999-05-21 Fanuc Ltd 軌跡誤差補正機能を有するロボット
JP2002326174A (ja) * 2002-04-26 2002-11-12 National Aerospace Laboratory Of Japan 多関節ロボットの制御方法
CN101314224A (zh) * 2007-05-30 2008-12-03 发那科株式会社 加工机器人的控制装置
CN203317711U (zh) * 2013-05-06 2013-12-04 深圳市齐创美科技有限公司 一种带智能控制系统的立式注塑机
CN104626168A (zh) * 2014-12-16 2015-05-20 苏州大学 基于智能算法的机器人力位柔顺控制方法
CN107263467A (zh) * 2017-05-11 2017-10-20 广州视源电子科技股份有限公司 控制机器人转动关节运动的方法和装置及机器人
CN109202958A (zh) * 2017-06-30 2019-01-15 沈阳新松机器人自动化股份有限公司 一种复合机器人视觉抓取平台
CN110281241A (zh) * 2019-06-27 2019-09-27 大连理工大学 基于激光跟踪仪测量机械臂运动学参数标定方法
CN110587611A (zh) * 2019-09-30 2019-12-20 中电九天智能科技有限公司 电视机组装线的机械臂控制方法
CN112571411A (zh) * 2019-09-30 2021-03-30 中电九天智能科技有限公司 用于电视机智能生产线的两用机械臂

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5383911B2 (ja) * 2010-06-22 2014-01-08 株式会社東芝 ロボット制御装置
WO2013069291A1 (ja) * 2011-11-10 2013-05-16 パナソニック株式会社 ロボット、ロボットの制御装置、制御方法、及び制御プログラム
JP6812095B2 (ja) * 2015-10-22 2021-01-13 キヤノン株式会社 制御方法、プログラム、記録媒体、ロボット装置、及び物品の製造方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11134012A (ja) * 1997-10-24 1999-05-21 Fanuc Ltd 軌跡誤差補正機能を有するロボット
JP2002326174A (ja) * 2002-04-26 2002-11-12 National Aerospace Laboratory Of Japan 多関節ロボットの制御方法
CN101314224A (zh) * 2007-05-30 2008-12-03 发那科株式会社 加工机器人的控制装置
CN203317711U (zh) * 2013-05-06 2013-12-04 深圳市齐创美科技有限公司 一种带智能控制系统的立式注塑机
CN104626168A (zh) * 2014-12-16 2015-05-20 苏州大学 基于智能算法的机器人力位柔顺控制方法
CN107263467A (zh) * 2017-05-11 2017-10-20 广州视源电子科技股份有限公司 控制机器人转动关节运动的方法和装置及机器人
CN109202958A (zh) * 2017-06-30 2019-01-15 沈阳新松机器人自动化股份有限公司 一种复合机器人视觉抓取平台
CN110281241A (zh) * 2019-06-27 2019-09-27 大连理工大学 基于激光跟踪仪测量机械臂运动学参数标定方法
CN110587611A (zh) * 2019-09-30 2019-12-20 中电九天智能科技有限公司 电视机组装线的机械臂控制方法
CN112571411A (zh) * 2019-09-30 2021-03-30 中电九天智能科技有限公司 用于电视机智能生产线的两用机械臂

Also Published As

Publication number Publication date
CN112571412A (zh) 2021-03-30

Similar Documents

Publication Publication Date Title
CN105773623B (zh) 基于预测型间接迭代学习的scara机器人轨迹跟踪控制方法
CN110561440B (zh) 一种冗余度机械臂加速度层多目标规划方法
CN106475999B (zh) 刚性条件下基于阻抗模型的双臂协调的加速度控制方法
CN109514602A (zh) 一种基于负载自适应辨识的工业机器人力矩补偿控制方法
CN110154024B (zh) 一种基于长短期记忆神经网络增量模型的装配控制方法
Tan et al. Minimum time trajectory planner for the discrete dynamic robot model with dynamic constraints
CN106041932B (zh) 一种ur机器人的运动控制方法
CN110861090B (zh) 一种力矩前馈控制系统及方法
CN204366962U (zh) 六轴重载机器人控制系统
CN110587611B (zh) 电视机组装线的机械臂控制方法
CN109352656B (zh) 一种具有时变输出约束的多关节机械臂控制方法
CN105033996A (zh) 基于手推示教式五轴水平关节机器人的控制系统
CN111230882A (zh) 一种水果分拣并联机器人夹持机构的自适应变阻抗控制方法
CN111687827A (zh) 一种双机器人协调操作弱刚性构件的控制方法和控制系统
CN110695994B (zh) 一种面向双臂机械手协同重复运动的有限时间规划方法
CN107791244A (zh) 控制器、作业控制装置、多轴动作控制装置和驱动控制装置
CN112571411B (zh) 用于电视机智能生产线的两用机械臂
CN112571412B (zh) 一种智能制造设备的控制系统
CN113103262A (zh) 机器人控制装置和用于控制机器人的方法
CN113664830B (zh) 基于模型预测阻抗控制的双机器人同步加工方法及系统
Isma et al. Time-dependant trajectory generation for tele-operated mobile manipulator
Nuritdinovich et al. The concept of the mathematical description of the multi-coordinate mechatronic module of the robot
CN114740735A (zh) 单关节机器人的变长度反馈辅助pd型迭代学习控制方法
Flacco et al. Discrete-time velocity control of redundant robots with acceleration/torque optimization properties
Du et al. Multi-DOF Robotic Manipulator Trajectory Controlling based on Minimum Energy Optimization

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