CN102615647A - 工业机器人的多轴运动控制方法 - Google Patents
工业机器人的多轴运动控制方法 Download PDFInfo
- Publication number
- CN102615647A CN102615647A CN2012100997054A CN201210099705A CN102615647A CN 102615647 A CN102615647 A CN 102615647A CN 2012100997054 A CN2012100997054 A CN 2012100997054A CN 201210099705 A CN201210099705 A CN 201210099705A CN 102615647 A CN102615647 A CN 102615647A
- Authority
- CN
- China
- Prior art keywords
- industrial robot
- movement
- control
- signal
- control method
- 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
Links
Images
Landscapes
- Numerical Control (AREA)
Abstract
本发明公开了一种工业机器人的多轴运动控制方法，其特征在于，包括以下步骤：（1）通过计算机获取工业机器人各轴的当前数据，并利用该当前数据生成控制工业机器人各轴下一步运动的时钟信号和动作信号；（2）利用时钟管理单元对时钟信号进行处理，并生成控制各轴同步运动的同步时钟信号；（3）通过插补模块对同步时钟信号和动作信号进行处理，生成控制工业机器人各轴运动的控制脉冲指令；（4）向工业机器人各轴驱动器同步发出控制脉冲指令，实现各轴的同步运动。本发明不仅能控制工业机器人的多个轴进行同步运动，还能对控制轴运动的指令数据进行校正，因此能很好地保证多个轴同步运动的精准度，因此适合推广运用。
Description
技术领域
本发明涉及一种工业机器人的轴运动控制方法，具体是指一种工业机器人的多轴运动控制方法。
背景技术
目前使用的工业机器人通常使用软件插补方式来对轴运动进行控制，由于该控制方式是由软件来实现的，而软件程序在执行时是按顺序进行的，因此对于具有多个轴的机器人的轴运动只能按顺序进行运动，而不能使多个轴进行同步运动。
发明内容
本发明的目的在于克服目前使用的机器人通常使用软件插补方式来对轴运动进行控制，从而使机器人的多个轴不能进行同步运动的缺陷，提供一种能控制工业机器人的多个轴进行同步运动的基于工业机器人的多轴运动控制方法。
本发明通过下述技术方案实现：工业机器人的多轴运动控制方法，包括以下步骤：
（1）通过计算机获取工业机器人各轴的当前数据，并利用该当前数据生成控制工业机器人各轴下一步运动的时钟信号和动作信号；
（2）利用时钟管理单元对时钟信号进行处理，并生成控制各轴同步运动的同步时钟信号；
（3）通过插补模块对同步时钟信号和动作信号进行处理，生成控制工业机器人各轴运动的控制脉冲指令；
（4）向工业机器人各轴驱动器同步发出控制脉冲指令，实现各轴的同步运动。
进一步的，所述步骤（1）中获取工业机器人各轴的当前数据的具体步骤如下：
（1a）轴驱动器将轴当前运动的位置脉冲经高速光电隔离电路反馈至位置反馈模块；
（1b）位置反馈模块将接收到的位置脉冲处理成各轴的当前数据，并存储于双端口RAM中；
（1c）计算机实时地从双端口RAM中读取各轴的当前数据。
再进一步的，还包括异常情况的安全控制方法，包括以下步骤：
（Ⅰ）当安全逻辑模块接收到安全异常信号时，安全逻辑模块进行时序控制，并将控制信号同时输入到插补模块和各轴驱动器；
（Ⅱ）插补模块接收到来自安全逻辑模块的控制信号后，清除所有的控制脉冲指令，与此同时，各轴驱动器进行紧急制动。
为了满足需要，所述步骤（3）中插补模块对同步时钟信号和动作信号进行处理的方法为：插补模块根据时钟管理单元产生的时钟频率从双端口RAM中提取各轴的当前数据，用以进行各轴的轨迹同步规算，之后，将同步规算的结果再写入双端口RAM中。
为了更好的实现本发明，所述步骤（3）中生成控制工业机器人各轴运动的控制脉冲指令的方法如下：
首先，插补模块根据轨迹同步规算的结果产生指令脉冲数据；然后，由
差分输出电路将指令脉冲数据处理成与工业机器人轴数量相同的控制脉冲指令。
为了确保效果，所述步骤（2）中的同步时钟信号与步骤（1）中的动作信号均存入双端口RAM中。
本发明与现有技术相比，具有以下优点及有益效果：
（1）本发明通过时钟管理单元对时钟信号进行处理后生成控制各轴同步运动的同步时钟信号；然后对动作信号以及同步时钟信号进行处理，并生成轴运动的控制脉冲指令；最后将控制脉冲指令同步发出，从而控制多个轴同步运动，从而实现了机器人的多个轴进行同步运动。
（2）本发明还包括将各轴实时动作的信号反馈至计算机的步骤，方便计算机获取机器人各轴的实时动作信号，从而方便计算机根据轴实时的动作信号进行同步校正，因此使计算机再次发送的控制指令能更精准的控制多轴同步运动。
（3）本发明还包括出现安全异常时紧急制动的步骤，方便在出现紧急停止、机器人碰撞、驱动器报警等异常情况时以最快的速度使机器人停止动作，从而有效地保证了操作人员的人身安全。
（4）本发明的同步时钟信号以及轴的动作信号均存入双端口RAM中，因此方便计算机读取信息。
附图说明
图1为本发明的多轴同步运动的流程图。
图2为本发明的轴运动信号反馈至计算机的流程图。
图3为本发明紧急停止轴运动时的流程图。
具体实施方式
下面结合实施例对本发明作进一步地详细说明，但本发明的实施方式不限于此。
实施例
如图1～3所示，本发明主要是控制工业机器人的多个轴同时运动，其流程如图1所示。首先，用户需要预先设定轴运动的控制指令，从而使工业机器人的各个轴按照预先设定的指令动作。用户将设定的控制指令输入计算机，计算机对控制指令进行处理，并生成控制轴运动的时钟信号以及动作信号。所述动作信号包括控制轴动作的位置数据与运动速度数据，从而使机器人的各个轴按照时钟信号与动作信号进行运动。
所述动作信号通过总线驱动IC发送至双端口RAM中进行保存，而时钟信号则通过总线驱动IC发送至时钟管理单元，时钟管理单元对多个轴的时钟信号进行处理，并生成控制多个轴同时动作的时钟频率，然后将生成的时钟频率也存入双端口RAM中。该时钟管理单元还将生成的时钟频率发送至轴插补模块，轴插补模块则根据时钟频率从双端口RAM中提取动作信号，并进行多轴同步运动的轨迹同步规算。
所述轴插补模块进行轨迹同步规算后生成指令脉冲数据，并将该指令脉冲数据写入双端口RAM中进行保存，以方便计算机校验插补数据。同时，该轴插补模块还将指令脉冲数据发送至差分输出电路，差分输出电路则对该指令脉冲数据进行处理，并生成控制每个轴运动的控制脉冲指令。差分输出电路将控制每个轴运动的控制脉冲指令同步输出至驱动器，驱动器驱动电机工作，电机则带动轴运动，且该驱动器与电机以及轴一一对应，即第一驱动器驱动第一电机，第一电机则带动1轴运动；第二驱动器驱动第二电机，第二电机则带动2轴运动；……第n驱动器驱动第n电机，第n电机，则带动n轴运动。所述n个驱动器同时接收到控制轴运动的控制脉冲指令，则该n个驱动器同时驱动相应的电机工作，即n个电机同时工作，并带动相应的n个轴同步运动。
如图2所示，为了便于计算机校验插补数据，以便于对各轴的运动进行校正，所述各个轴驱动器将其对应的轴实时运动的动作信号进行反馈。所述轴实时运动的动作信号通过电机反馈至轴驱动器，轴驱动器则将该动作信号反馈至高速光电隔离电路。所述高速光电隔离电路对各个轴的动作信号进行整合，并生成各轴的位置反馈脉冲数据，然后将该位置反馈脉冲数据反馈至轴位置反馈模块。
所述轴位置反馈模块对各轴的位置反馈脉冲数据进行解析，并得出每个轴的位置数据，然后将每个轴的位置数据存入双端口RAM中。计算机通过该双端口RAM实时的读取每个轴的位置数据，并对该数据进行校正，然后将校正后的数据重新生成控制各轴运动的时钟信号以及动作信号，该时钟信号以及动作信号通过如图1所示的流程图进行处理后重新控制轴同步运动，从而对轴的运动进行校正，使各轴能更好的进行同步运动。
如图3所示，当有安全异常如紧急停止、机器人碰撞、驱动器报警等信号输入时，该安全异常信号经安全逻辑模块进行处理。所述安全逻辑模块经时序控制后输出信号到轴插补模块，并清除轴插补模块中的所有缓存指令脉冲，使轴插补模块停止输出信号，即使轴插补模块停止向轴驱动器发送控制轴运动的指令。同时，安全逻辑模块还向逻辑驱动电路发送安全异常信号，该逻辑驱动电路将安全异常信号转化为安全逻辑控制信号，并通过轴驱动器的控制接口将该安全逻辑控制信号输入轴驱动器中，该轴驱动器接收到安全逻辑信号后紧急制动，同时切断电机电源，并抱紧电机的刹车，从而以最快的速度使机器人停止动作，以此保护操作人员的人身安全。
如上所述，便可较好的实现本发明。
Claims (6)
1.工业机器人的多轴运动控制方法，其特征在于，包括以下步骤：
（1）通过计算机获取工业机器人各轴的当前数据，并利用该当前数据生成控制工业机器人各轴下一步运动的时钟信号和动作信号；
（2）利用时钟管理单元对时钟信号进行处理，并生成控制各轴同步运动的同步时钟信号；
（3）通过插补模块对同步时钟信号和动作信号进行处理，生成控制工业机器人各轴运动的控制脉冲指令；
（4）向工业机器人各轴驱动器同步发出控制脉冲指令，实现各轴的同步运动。
2.根据权利要求1所述的工业机器人的多轴运动控制方法，其特征在于，所述步骤（1）中获取工业机器人各轴的当前数据的具体步骤如下：
（1a）轴驱动器将轴当前运动的位置脉冲经高速光电隔离电路反馈至位置反馈模块；
（1b）位置反馈模块将接收到的位置脉冲处理成各轴的当前数据，并存储于双端口RAM中；
（1c）计算机实时地从双端口RAM中读取各轴的当前数据。
3.根据权利要求1或2所述的工业机器人的多轴运动控制方法，其特征在于，还包括异常情况的安全控制方法，包括以下步骤：
（Ⅰ）当安全逻辑模块接收到安全异常信号时，安全逻辑模块进行时序控制，并将控制信号同时输入到插补模块和各轴驱动器；
（Ⅱ）插补模块接收到来自安全逻辑模块的控制信号后，清除所有的控制脉冲指令，与此同时，各轴驱动器进行紧急制动。
4.根据权利要求3所述的工业机器人的多轴运动控制方法，其特征在于，所述步骤（3）中插补模块对同步时钟信号和动作信号进行处理的方法为：插补模块根据时钟管理单元产生的时钟频率从双端口RAM中提取各轴的当前数据，用以进行各轴的轨迹同步规算，之后，将同步规算的结果再写入双端口RAM中。
5.根据权利要求4所述的工业机器人的多轴运动控制方法，其特征在于，所述步骤（3）中生成控制工业机器人各轴运动的控制脉冲指令的方法如下：
首先，插补模块根据轨迹同步规算的结果产生指令脉冲数据；然后，由
差分输出电路将指令脉冲数据处理成与工业机器人轴数量相同的控制脉冲指令。
6.根据权利要求4或5所述的工业机器人的多轴运动控制方法，其特征在于，所述步骤（2）中的同步时钟信号与步骤（1）中的动作信号均存入双端口RAM中。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210099705.4A CN102615647B (zh) | 2012-04-09 | 2012-04-09 | 工业机器人的多轴运动控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210099705.4A CN102615647B (zh) | 2012-04-09 | 2012-04-09 | 工业机器人的多轴运动控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102615647A true CN102615647A (zh) | 2012-08-01 |
| CN102615647B CN102615647B (zh) | 2015-04-01 |
Family
ID=46556029
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201210099705.4A Active CN102615647B (zh) | 2012-04-09 | 2012-04-09 | 工业机器人的多轴运动控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102615647B (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109343473A (zh) * | 2018-09-27 | 2019-02-15 | 中国科学院力学研究所 | 一种基于双时钟的高速高精度多轴同步运动的控制方法 |
| CN109986558A (zh) * | 2019-02-26 | 2019-07-09 | 浙江树人学院（浙江树人大学） | 基于误差补偿的工业机器人运动控制方法 |
| CN110315542A (zh) * | 2019-07-27 | 2019-10-11 | 南京市晨枭软件技术有限公司 | 一种工业机器人的多轴运动控制方法 |
| CN111515947A (zh) * | 2014-05-21 | 2020-08-11 | X开发有限责任公司 | 用于时基并行机器人操作的系统和方法 |
| CN112207824A (zh) * | 2020-09-22 | 2021-01-12 | 慧灵科技（深圳）有限公司 | 多个单轴模组的控制方法、系统、装置及存储介质 |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6061803A (ja) * | 1983-09-02 | 1985-04-09 | ジイマ−ク コ−ポレ−シヨン | コンピユ−タ化した自己構成式ロボツト制御システム |
| CN1484807A (zh) * | 2000-12-28 | 2004-03-24 | 自动装置工作空间技术有限公司 | 多功能机器人控制系统 |
| JP2005301508A (ja) * | 2004-04-08 | 2005-10-27 | Fanuc Ltd | 制御装置 |
| CN1818895A (zh) * | 2006-03-20 | 2006-08-16 | 哈尔滨工业大学 | 一种串并综合型总线系统及其数据传送方法 |
| CN2876850Y (zh) * | 2006-03-20 | 2007-03-07 | 高波 | 一种串并综合型总线系统 |
| CN101200066A (zh) * | 2006-12-11 | 2008-06-18 | Abb研究有限公司 | 用于监控工业机器人的状态的方法和控制系统 |
| CN101387879A (zh) * | 2007-09-14 | 2009-03-18 | 广州数控设备有限公司 | 数控设备运动精度测试装置及测试方法 |
| CN101443163A (zh) * | 2006-05-16 | 2009-05-27 | Abb公司 | 用于工业机器人的控制系统 |
| CN101526808A (zh) * | 2009-01-09 | 2009-09-09 | 成都广泰实业有限公司 | 机床数控软硬件多轴插补方法 |
| CN102291028A (zh) * | 2011-08-17 | 2011-12-21 | 福州大学 | 基于有源功率因数校正芯片控制的微功率并网逆变器 |
| CN102310407A (zh) * | 2011-04-22 | 2012-01-11 | 三一重工股份有限公司 | 一种机械臂仿生控制方法及控制系统 |
-
2012
- 2012-04-09 CN CN201210099705.4A patent/CN102615647B/zh active Active
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6061803A (ja) * | 1983-09-02 | 1985-04-09 | ジイマ−ク コ−ポレ−シヨン | コンピユ−タ化した自己構成式ロボツト制御システム |
| CN1484807A (zh) * | 2000-12-28 | 2004-03-24 | 自动装置工作空间技术有限公司 | 多功能机器人控制系统 |
| JP2005301508A (ja) * | 2004-04-08 | 2005-10-27 | Fanuc Ltd | 制御装置 |
| CN1818895A (zh) * | 2006-03-20 | 2006-08-16 | 哈尔滨工业大学 | 一种串并综合型总线系统及其数据传送方法 |
| CN2876850Y (zh) * | 2006-03-20 | 2007-03-07 | 高波 | 一种串并综合型总线系统 |
| CN101443163A (zh) * | 2006-05-16 | 2009-05-27 | Abb公司 | 用于工业机器人的控制系统 |
| CN101200066A (zh) * | 2006-12-11 | 2008-06-18 | Abb研究有限公司 | 用于监控工业机器人的状态的方法和控制系统 |
| CN101387879A (zh) * | 2007-09-14 | 2009-03-18 | 广州数控设备有限公司 | 数控设备运动精度测试装置及测试方法 |
| CN101526808A (zh) * | 2009-01-09 | 2009-09-09 | 成都广泰实业有限公司 | 机床数控软硬件多轴插补方法 |
| CN102310407A (zh) * | 2011-04-22 | 2012-01-11 | 三一重工股份有限公司 | 一种机械臂仿生控制方法及控制系统 |
| CN102291028A (zh) * | 2011-08-17 | 2011-12-21 | 福州大学 | 基于有源功率因数校正芯片控制的微功率并网逆变器 |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111515947A (zh) * | 2014-05-21 | 2020-08-11 | X开发有限责任公司 | 用于时基并行机器人操作的系统和方法 |
| CN109343473A (zh) * | 2018-09-27 | 2019-02-15 | 中国科学院力学研究所 | 一种基于双时钟的高速高精度多轴同步运动的控制方法 |
| CN109343473B (zh) * | 2018-09-27 | 2020-02-14 | 中国科学院力学研究所 | 一种基于双时钟的高速高精度多轴同步运动的控制方法 |
| CN109986558A (zh) * | 2019-02-26 | 2019-07-09 | 浙江树人学院（浙江树人大学） | 基于误差补偿的工业机器人运动控制方法 |
| CN110315542A (zh) * | 2019-07-27 | 2019-10-11 | 南京市晨枭软件技术有限公司 | 一种工业机器人的多轴运动控制方法 |
| CN112207824A (zh) * | 2020-09-22 | 2021-01-12 | 慧灵科技（深圳）有限公司 | 多个单轴模组的控制方法、系统、装置及存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102615647B (zh) | 2015-04-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102615647A (zh) | 工业机器人的多轴运动控制方法 | |
| CN103699056B (zh) | 高速高精度数控加工的小线段实时平滑过渡插补方法 | |
| CN104044049B (zh) | 一种具备力反馈控制的五轴联动抛光系统 | |
| CN103728923A (zh) | 一种高效高平稳的数控系统柔性加减速控制方法 | |
| JP6411964B2 (ja) | 工作機械とロボットのリアルタイム干渉確認システム | |
| CN103713579B (zh) | 一种工业机器人作业方法 | |
| CN104133400B (zh) | 一种基于数字总线的转盘磨刀机嵌入式控制器 | |
| CN112453428B (zh) | 一种双通道激光增材制造数控系统 | |
| DE112011104865B4 (de) | Sensorsteuervorrichtung | |
| CN101526808A (zh) | 机床数控软硬件多轴插补方法 | |
| US8667475B2 (en) | Computer-readable storage medium and program-converting method | |
| US9823644B2 (en) | Numerical control device and numerical control system | |
| CN204065733U (zh) | 一种基于数字总线的转盘磨刀机嵌入式控制器 | |
| CN104635624A (zh) | 用于控制四轴加工设备的数控系统控制方法及其控制系统 | |
| EP1182524A1 (en) | Programmable controller | |
| CN102909605B (zh) | 具自动设定车牙退刀距离与角度的cnc车床控制器 | |
| CN106325221B (zh) | 事先通知辅助功能的执行的数值控制装置 | |
| CN103809519B (zh) | 数控系统用极坐标插补极值区域平滑处理方法 | |
| CN105345813B (zh) | 一种基于广义坐标的机械手高精度定位方法 | |
| CN115685886A (zh) | 一种基于EtherCAT网络通信的联动激光打标控制卡 | |
| CN103926877A (zh) | 一种多轴联动数控系统及其加工方法 | |
| CN103914042B (zh) | 智能工厂及其柔性执行单元、柔性智能化设备 | |
| CN104714483A (zh) | 激光加工的控制方法及系统 | |
| TW201344383A (zh) | 使用於工具機之加工路徑最佳化方法 | |
| CN102873685A (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: 20120801 Assignee: CRP AUTOMATION CONTROL TECHNOLOGY CO., LTD. Assignor: Deng Shihai Contract record no.: 2015510000110 Denomination of invention: Multi-axis movement control method of industrial robot Granted publication date: 20150401 License type: Exclusive License Record date: 20150730 |
|
| LICC | Enforcement, change and cancellation of record of contracts on the licence for exploitation of a patent or utility model | ||
| C41 | Transfer of patent application or patent right or utility model | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20160503 Address after: 610052 No. 199 Hua Guan Road, Chengdu, Sichuan, Chenghua District Patentee after: CRP AUTOMATION CONTROL TECHNOLOGY CO., LTD. Address before: 610000 No. 5, Jingan Road, Jinjiang District, Sichuan, 5, attached, No. Chengdu Patentee before: Deng Shihai |
|
| CP03 | Change of name, title or address |
Address after: 610000 No. 42, Huatai Road, Chenghua District, Chengdu, Sichuan Patentee after: Chengdu kanop Robot Technology Co.,Ltd. Address before: No. 199, Huaguan Road, Chenghua District, Chengdu, Sichuan 610052 Patentee before: CHENGDU CRP AUTOMATION CONTROL TECHNOLOGY Co.,Ltd. |
|
| CP03 | Change of name, title or address |