[go: up one dir, main page]

CN103737603A - 一种流水线上机械臂精确控制系统及控制方法 - Google Patents

一种流水线上机械臂精确控制系统及控制方法 Download PDF

Info

Publication number
CN103737603A
CN103737603A CN201310734876.4A CN201310734876A CN103737603A CN 103737603 A CN103737603 A CN 103737603A CN 201310734876 A CN201310734876 A CN 201310734876A CN 103737603 A CN103737603 A CN 103737603A
Authority
CN
China
Prior art keywords
motion
control
mechanical arm
controller
motion control
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
CN201310734876.4A
Other languages
English (en)
Other versions
CN103737603B (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.)
Liuzhou Vocational and Technical College
Original Assignee
Liuzhou Vocational and Technical College
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 Liuzhou Vocational and Technical College filed Critical Liuzhou Vocational and Technical College
Priority to CN201310734876.4A priority Critical patent/CN103737603B/zh
Publication of CN103737603A publication Critical patent/CN103737603A/zh
Application granted granted Critical
Publication of CN103737603B publication Critical patent/CN103737603B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position Or Direction (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种流水线上机械臂精确控制系统，它包括传感器、运动控制器、PID控制器和运动控制处理器，传感器、运动控制器、PID控制器和运动控制处理器设置在在机械臂的各运动关节点上。一种流水线上机械臂精确控制方法，其具体技术方案为：用户确定机械臂的加工运动轨迹路线；机械臂控制系统根据用户输入的机械臂运动轨迹路线图，对任务进行分解；根据输入的控制参量输出运动控制结果，驱动机械臂关节点进行相应的运动控制；运动控制处理器对机械臂的运动过程进行驱动，定位到当前机械臂的运动状态，而且根据机械臂运动控制预先设定的运动轨迹，由运动控制处理器执行运动控制任务。本发明提高了对于机械臂控制的效率和响应速度，保障了机械臂运动过程控制的准确性和精确性。

Description

一种流水线上机械臂精确控制系统及控制方法
技术领域
    本发明属于一种应用在流水线上的机械臂精确控制领域，尤其是具有固定运动轨迹特征的机械臂运动控制系统和方法。
背景技术
目前在现代加工生产流水线上有着大量的机械臂代替人工的手工操作。通过利用机械臂实现产品的加工和装配，能够大幅度提高产品加工的效率，降低人工成本。然而在生产流水线上所部署的大量机械臂进行加工生产时，特别注重机械臂的运动控制精度，尤其是对一些加工装配相对机密的应用场合，对机械臂的应用精度提出了更高的要求。另一方面应用于加工装配的机械臂结构复杂，对机械臂的运动过程也相对复杂。为了提高机械臂加工装配的效率，对机械臂运动控制的响应速度又提出了较高的要求。
发明内容
   本发明所要解决的技术问题是提供一种流水线上机械臂精确控制系统及
控制方法，能够满足生产流水线机械臂的运动控制要求，并为流水线的生产提供高效率的控制效果。
为解决上述技术问题，本发明提供一种流水线上机械臂精确控制系统，它包括传感器、运动控制器、PID控制器和运动控制处理器，传感器、运动控制器、PID控制器和运动控制处理器设置在在机械臂的各运动关节点上，传感器获取机械臂各关节点当前的控制状态；运动控制器则是向机械臂的关节点发出运动控制信号，促使关节点按预定的方式进行运动；PID控制器实现运动过程的控制，以确保机械臂运动关节点的运动控制过程，能够实现快速稳定的控制效果；运动控制处理器计算机械臂当前的运动状态，将控制信息通过PID控制器传输至关节点的运动控制器，由运动控制器直接控制关节点的运动角度，运动控制处理器包括多处理器运动协同控制器，协调每个关节点上PID控制器和运动控制器任务执行。
所述的运动控制处理器还包括协从MCUARM处理器，以便更迅速的协调每个关节点上PID控制器和运动控制器任务执行。
所述的PID控制器包括比例控制器、积分控制器和微分控制器，以更细微精确的对运动控制器进行控制，达到精确控制机械臂运动的目的。
所述的每个PID控制器分别对三维中X轴、Y轴、Z轴运动量进行控制。
一种流水线上机械臂精确控制方法，其具体技术方案为：
一、机械臂工作之前，由用户确定机械臂的加工运动轨迹路线，并将所确定的加工轨迹路径作为输入参数，送给机械臂控制系统；
二、机械臂控制系统根据用户输入的机械臂运动轨迹路线图，对任务进行分解，根据机械臂的运动轨迹路径，确定机械臂各运动关节点的控制顺序，从第一个机械臂关节点运动控制任务为起点，计算该关节点当前的状态与运动目标点之间的差值，计算出当前关节点的运动控制要求，之后以某一关节点的运动差值作为输入条件，计算该关节点的运动结果对另一关节点的影响情况，之后再结合初始设定的运动轨迹路线，计算关节点的运动控制差值，如此不断传递，最后得到机械臂上所有关节点的运动控制差值，再将所计算得到的运动控制差值分别传给每个关节点的控制处理器；
三、单个的关节点运动控制处理器收到运动控制差值信号之后，将控制信号送入PID控制器，根据输入的控制参量输出运动控制结果，驱动机械臂关节点进行相应的运动控制；
四、机械臂上的运动控制处理器对机械臂的运动过程进行驱动，同时对机械臂当前所处的状态进行采样，采样过程中由部署在机械臂上的位置传感器，获取机械臂的位置信息，运动控制处理器根据采集到的位置信息，定位到当前机械臂的运动状态，同时运动控制处理器从预先规划的运动轨迹路线中读取初始的运动轨迹信息，将二者进行对比计算当前的运动位置差值，而且根据机械臂运动控制预先设定的运动轨迹，还能够计算得到当前运动状态到下一个运动状态之间的时间差，之后运动控制处理器将计算得到的运动位置差值和时间差值，共同送入协从处理器，协从处理器经分析之后给运动控制处理器反馈信息，由运动控制处理器执行运动控制任务。
所述的运动控制处理器对机械臂运动轨迹路径任务的拆分，并将运动轨迹控制任务拆分成机械臂多个关节的具体控制任务，并协同机械臂各个从控制器联合工作，共同实现机械臂的运动控制任务。
本发明所提出的一种流水线上机械臂精确控制系统及控制方法，提高了对于机械臂控制的效率和响应速度，保障了机械臂运动过程控制的准确性和精确性。
附图说明
图1是本发明所提出的一种流水线上机械臂精确控制系统示意图。
图2是PID控制器控制原理示意图。
图3是一种流水线上机械臂精确控制方法流程示意图。
图4是关节点间运动控制器控制原理图。
具体实施方式
参见附图，一种流水线上机械臂精确控制系统，它包括传感器、运动控制器、PID控制器和运动控制处理器，传感器、运动控制器、PID控制器和运动控制处理器设置在在机械臂的各运动关节点上，传感器获取机械臂各关节点当前的控制状态；运动控制器则是向机械臂的关节点发出运动控制信号，促使关节点按预定的方式进行运动；PID控制器实现运动过程的控制，以确保机械臂运动关节点的运动控制过程，能够实现快速稳定的控制效果；运动控制处理器计算机械臂当前的运动状态，将控制信息通过PID控制器传输至关节点的运动控制器，由运动控制器直接控制关节点的运动角度，运动控制处理器包括多处理器运动协同控制器，协调每个关节点上PID控制器和运动控制器任务执行。
所述的运动控制处理器还包括协从MCUARM处理器，以便更迅速的协调每个关节点上PID控制器和运动控制器任务执行。
所述的PID控制器包括比例控制器、积分控制器和微分控制器，以更细微精确的对运动控制器进行控制，达到精确控制机械臂运动的目的。
所述的每个PID控制器分别对三维中X轴、Y轴、Z轴运动量进行控制。
一种流水线上机械臂精确控制方法，其具体技术方案为：
一、机械臂工作之前，由用户确定机械臂的加工运动轨迹路线，并将所确定的加工轨迹路径作为输入参数，送给机械臂控制系统；
二、机械臂控制系统根据用户输入的机械臂运动轨迹路线图，对任务进行分解，根据机械臂的运动轨迹路径，确定机械臂各运动关节点的控制顺序，从第一个机械臂关节点运动控制任务为起点，计算该关节点当前的状态与运动目标点之间的差值，计算出当前关节点的运动控制要求，之后以某一关节点的运动差值作为输入条件，计算该关节点的运动结果对另一关节点的影响情况，之后再结合初始设定的运动轨迹路线，计算关节点的运动控制差值，如此不断传递，最后得到机械臂上所有关节点的运动控制差值，再将所计算得到的运动控制差值分别传给每个关节点的控制处理器；
三、单个的关节点运动控制处理器收到运动控制差值信号之后，将控制信号送入PID控制器，根据输入的控制参量输出运动控制结果，驱动机械臂关节点进行相应的运动控制；
四、机械臂上的运动控制处理器对机械臂的运动过程进行驱动，同时对机械臂当前所处的状态进行采样，采样过程中由部署在机械臂上的位置传感器，获取机械臂的位置信息，运动控制处理器根据采集到的位置信息，定位到当前机械臂的运动状态，同时运动控制处理器从预先规划的运动轨迹路线中读取初始的运动轨迹信息，将二者进行对比计算当前的运动位置差值，而且根据机械臂运动控制预先设定的运动轨迹，还能够计算得到当前运动状态到下一个运动状态之间的时间差，之后运动控制处理器将计算得到的运动位置差值和时间差值，共同送入协从处理器，协从处理器经分析之后给运动控制处理器反馈信息，由运动控制处理器执行运动控制任务。
所述的运动控制处理器对机械臂运动轨迹路径任务的拆分，并将运动轨迹控制任务拆分成机械臂多个关节的具体控制任务，并协同机械臂各个从控制器联合工作，共同实现机械臂的运动控制任务。
本发明所提出的一种流水线上机械臂精确控制系统及控制方法，提高了对于机械臂控制的效率和响应速度，保障了机械臂运动过程控制的准确性和精确性。

Claims (6)

1.一种流水线上机械臂精确控制系统，它包括传感器、运动控制器、PID控制器和运动控制处理器，其特征在于传感器、运动控制器、PID控制器和运动控制处理器设置在在机械臂的各运动关节点上，传感器获取机械臂各关节点当前的控制状态；运动控制器则是向机械臂的关节点发出运动控制信号，促使关节点按预定的方式进行运动；PID控制器实现运动过程的控制，以确保机械臂运动关节点的运动控制过程，能够实现快速稳定的控制效果；运动控制处理器计算机械臂当前的运动状态，将控制信息通过PID控制器传输至关节点的运动控制器，由运动控制器直接控制关节点的运动角度，运动控制处理器包括多处理器运动协同控制器，协调每个关节点上PID控制器和运动控制器任务执行。
2.根据权利要求1所述的一种流水线上机械臂精确控制系统，其特征在于运动控制处理器还包括协从MCUARM处理器，以便更迅速的协调每个关节点上PID控制器和运动控制器任务执行。
3.根据权利要求1所述的一种流水线上机械臂精确控制系统，其特征在于所述的PID控制器包括比例控制器、积分控制器和微分控制器，以更细微精确的对运动控制器进行控制，达到精确控制机械臂运动的目的。
4.根据权利要求1所述的一种流水线上机械臂精确控制系统，其特征在于所述的每个PID控制器分别对三维中X轴、Y轴、Z轴运动量进行控制。
5.一种流水线上机械臂精确控制方法，其具体技术方案为：
一、机械臂工作之前，由用户确定机械臂的加工运动轨迹路线，并将所确定的加工轨迹路径作为输入参数，送给机械臂控制系统；
二、机械臂控制系统根据用户输入的机械臂运动轨迹路线图，对任务进行分解，根据机械臂的运动轨迹路径，确定机械臂各运动关节点的控制顺序，从第一个机械臂关节点运动控制任务为起点，计算该关节点当前的状态与运动目标点之间的差值，计算出当前关节点的运动控制要求，之后以某一关节点的运动差值作为输入条件，计算该关节点的运动结果对另一关节点的影响情况，之后再结合初始设定的运动轨迹路线，计算关节点的运动控制差值，如此不断传递，最后得到机械臂上所有关节点的运动控制差值，再将所计算得到的运动控制差值分别传给每个关节点的控制处理器；
三、单个的关节点运动控制处理器收到运动控制差值信号之后，将控制信号送入PID控制器，根据输入的控制参量输出运动控制结果，驱动机械臂关节点进行相应的运动控制；
四、机械臂上的运动控制处理器对机械臂的运动过程进行驱动，同时对机械臂当前所处的状态进行采样，采样过程中由部署在机械臂上的位置传感器，获取机械臂的位置信息，运动控制处理器根据采集到的位置信息，定位到当前机械臂的运动状态，同时运动控制处理器从预先规划的运动轨迹路线中读取初始的运动轨迹信息，将二者进行对比计算当前的运动位置差值，而且根据机械臂运动控制预先设定的运动轨迹，还能够计算得到当前运动状态到下一个运动状态之间的时间差，之后运动控制处理器将计算得到的运动位置差值和时间差值，共同送入协从处理器，协从处理器经分析之后给运动控制处理器反馈信息，由运动控制处理器执行运动控制任务。
6.根据权利要求5所述的一种流水线上机械臂精确控制方法，其特征在于所述的运动控制处理器对机械臂运动轨迹路径任务的拆分，并将运动轨迹控制任务拆分成机械臂多个关节的具体控制任务，并协同机械臂各个从控制器联合工作，共同实现机械臂的运动控制任务。
CN201310734876.4A 2013-12-27 2013-12-27 一种流水线上机械臂精确控制系统及控制方法 Active CN103737603B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310734876.4A CN103737603B (zh) 2013-12-27 2013-12-27 一种流水线上机械臂精确控制系统及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310734876.4A CN103737603B (zh) 2013-12-27 2013-12-27 一种流水线上机械臂精确控制系统及控制方法

Publications (2)

Publication Number Publication Date
CN103737603A true CN103737603A (zh) 2014-04-23
CN103737603B CN103737603B (zh) 2015-12-02

Family

ID=50494705

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310734876.4A Active CN103737603B (zh) 2013-12-27 2013-12-27 一种流水线上机械臂精确控制系统及控制方法

Country Status (1)

Country Link
CN (1) CN103737603B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104385279A (zh) * 2014-09-26 2015-03-04 京东方科技集团股份有限公司 一种机械手示教方法及系统
CN105511258A (zh) * 2015-11-27 2016-04-20 中国航空工业集团公司沈阳飞机设计研究所 一种登机门操纵机构可靠性试验自动控制方法及装置
WO2018019111A1 (zh) * 2016-07-29 2018-02-01 深圳光启合众科技有限公司 机器人及其关节运动控制方法和装置
CN117601154A (zh) * 2024-01-24 2024-02-27 广州市雪蕾化妆品有限公司 一种香水生产运输用机械臂控制系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05150804A (ja) * 1991-11-29 1993-06-18 Fujitsu Ltd マニピユレータの繰り返し学習制御装置
US6233511B1 (en) * 1997-11-26 2001-05-15 Case Corporation Electronic control for a two-axis work implement
CN102354134A (zh) * 2011-09-02 2012-02-15 北京邮电大学 基于fpga的模块化双关节伺服控制系统
CN203109951U (zh) * 2013-01-17 2013-08-07 常州先进制造技术研究所 一种上下料机械手运动控制装置
CN203357452U (zh) * 2013-06-04 2013-12-25 施国兴 一种基于plc的流水线机械手控制系统
CN103692441A (zh) * 2013-12-19 2014-04-02 成都市卓睿科技有限公司 通过工作流技术模拟机械臂运动的系统及方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05150804A (ja) * 1991-11-29 1993-06-18 Fujitsu Ltd マニピユレータの繰り返し学習制御装置
US6233511B1 (en) * 1997-11-26 2001-05-15 Case Corporation Electronic control for a two-axis work implement
CN102354134A (zh) * 2011-09-02 2012-02-15 北京邮电大学 基于fpga的模块化双关节伺服控制系统
CN203109951U (zh) * 2013-01-17 2013-08-07 常州先进制造技术研究所 一种上下料机械手运动控制装置
CN203357452U (zh) * 2013-06-04 2013-12-25 施国兴 一种基于plc的流水线机械手控制系统
CN103692441A (zh) * 2013-12-19 2014-04-02 成都市卓睿科技有限公司 通过工作流技术模拟机械臂运动的系统及方法

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104385279A (zh) * 2014-09-26 2015-03-04 京东方科技集团股份有限公司 一种机械手示教方法及系统
CN105511258A (zh) * 2015-11-27 2016-04-20 中国航空工业集团公司沈阳飞机设计研究所 一种登机门操纵机构可靠性试验自动控制方法及装置
CN105511258B (zh) * 2015-11-27 2019-03-22 中国航空工业集团公司沈阳飞机设计研究所 一种登机门操纵机构可靠性试验自动控制方法及装置
WO2018019111A1 (zh) * 2016-07-29 2018-02-01 深圳光启合众科技有限公司 机器人及其关节运动控制方法和装置
CN117601154A (zh) * 2024-01-24 2024-02-27 广州市雪蕾化妆品有限公司 一种香水生产运输用机械臂控制系统
CN117601154B (zh) * 2024-01-24 2024-03-22 广州市雪蕾化妆品有限公司 一种香水生产运输用机械臂控制系统

Also Published As

Publication number Publication date
CN103737603B (zh) 2015-12-02

Similar Documents

Publication Publication Date Title
CN110238831B (zh) 基于rgb-d图像及示教器的机器人示教系统及方法
CN114378827B (zh) 一种基于移动机械臂整体控制的动态目标跟踪抓取方法
CN103240739B (zh) 一种移动机械臂分散集中自主切换控制方法
CN115319764B (zh) 在复杂受限环境下基于多模态融合的机器人及运行方法
CN108748152B (zh) 一种机器人示教方法及系统
CN117601115B (zh) 面向大型零件装配的复合协作机器人控制系统及方法
CN111015649B (zh) 一种驱控一体化控制系统
CN107717994A (zh) 基于主从空间映射的主从异构机器人通用控制方法及系统
CN114536346B (zh) 一种基于人机协作和视觉检测的机械臂精确路径规划方法
CN111515928B (zh) 机械臂运动控制系统
CN103737603B (zh) 一种流水线上机械臂精确控制系统及控制方法
CN204366962U (zh) 六轴重载机器人控制系统
CN107081787A (zh) 基于工业机器人内置传感器信号的运动特性检测方法
CN102806560A (zh) 一种可自动消除机器人运动累积误差的方法
CN105598970B (zh) 全闭环机器人系统及其控制方法
CN106695793A (zh) 一种xyzr四轴钻孔机器人主动柔顺控制装置及方法
CN103273497A (zh) 人机交互式机械手控制系统及其控制方法
CN105033996A (zh) 基于手推示教式五轴水平关节机器人的控制系统
CN108638052A (zh) 一种闭链式多臂机器人柔顺控制方法
CN104827483A (zh) 一种基于gps与双目视觉定位的移动机械手物体抓取方法
CN105911995B (zh) 一种基于位置速度控制的遥操作机器人碰撞预警方法
CN113146616A (zh) 一种四自由度机械臂视觉伺服控制方法
CN106777876A (zh) 一种用于机器人的旋转电弧焊缝跟踪系统信息处理方法
CN104090492B (zh) 基于指数函数的scara机器人ptp轨迹规划
CN113580146B (zh) 一种融合动态系统与模型预测控制的机械臂实时避障方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20140423

Assignee: Liuzhou Zhuode Machinery Technology Co.,Ltd.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2023980053806

Denomination of invention: A precise control system and control method for robotic arms on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20231225

EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20140423

Assignee: LIUZHOU RISUN FILTER CO.,LTD.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2024980020291

Denomination of invention: A precise control system and control method for a robotic arm on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20241025

EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20140423

Assignee: GUANGXI MINSTONE SOFTWARE Co.,Ltd.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2024980021079

Denomination of invention: A precise control system and control method for a robotic arm on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20241030

Application publication date: 20140423

Assignee: Guangxi Yanjia Information Security Technology Co.,Ltd.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2024980021077

Denomination of invention: A precise control system and control method for a robotic arm on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20241030

Application publication date: 20140423

Assignee: Liuzhou Wanchen Automotive Technology Co.,Ltd.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2024980021069

Denomination of invention: A precise control system and control method for a robotic arm on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20241030

Application publication date: 20140423

Assignee: LIUZHOU GENERATOR AUTOMOTIVE ELECTRICAL SYSTEMS MANUFACTURE CO.,LTD.

Assignor: LIUZHOU VOCATIONAL & TECHNICAL College

Contract record no.: X2024980021068

Denomination of invention: A precise control system and control method for a robotic arm on an assembly line

Granted publication date: 20151202

License type: Common License

Record date: 20241030

EE01 Entry into force of recordation of patent licensing contract