CN102886781A - 一种控制多自由度工业机器人关节运动启停的方法 - Google Patents
一种控制多自由度工业机器人关节运动启停的方法 Download PDFInfo
- Publication number
- CN102886781A CN102886781A CN2011102081315A CN201110208131A CN102886781A CN 102886781 A CN102886781 A CN 102886781A CN 2011102081315 A CN2011102081315 A CN 2011102081315A CN 201110208131 A CN201110208131 A CN 201110208131A CN 102886781 A CN102886781 A CN 102886781A
- Authority
- CN
- China
- Prior art keywords
- joint
- industrial robot
- coordinate
- speed
- dof
- 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.)
- Pending
Links
Images
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
一种控制多自由度工业机器人关节运动启停的方法，用于对工业机器人的运动控制。本发明实现了6自由度工业机器人各个关节同时启步同时停止，并且实现了对各个关节运动速度的调节。该方法包括如下步骤：在控制系统的程序中求出每个关节即将到达的坐标与刚刚到达的坐标之差，如果各个关节运动的是第一个步，这个坐标值差就等于每个关节即将到达的坐标值；求出几个关节将要运动的最大距离；计算第一步的计算结果与第二步的计算结果之比；将一个基速度乘以上一步计算出的值作为每一个关节运动的速度。可以通过按下操控面板上的“加速”和“减速”按钮来改变每个关节的运动速度。本发明的有益效果为：1.可以提高工业机器人的工作效率；2.可以让采用这种技术方案的工业机器人工作在对速度要求不同的生产场合；3.使对工业机器人各个关节运动的速度控制变得简便易行。
Description
技术领域
本发明属于工业机器人自动控制技术领域。
背景技术
多自由度工业机器人有多个关节，每个关节的运动由一个伺服电机来驱动。各个关节的运动是为了让末端关节安装的机械手从一个点运动到另一个点，进而完成工业机器人所从事的工作。机器人的各个关节的运动可以有二种方式，一种是各个关节采用按先后次序的运动方式；另外一种是同时起步同时停止的运动方式。一般工业机器人大多都工作在生产线上，对它们有一个工作节拍的要求，也就是效率要求。如果机器人的各个关节采用按先后次序运动方式，就会影响工作效率。无法胜任快节奏的生产场合。
发明内容
本发明的目的在于提供一种让多自由度工业机器人的各个关节运动能够同时起步同时停止的技术方案。采用这种技术方案，不但可以实现工业机器人的各个关节运动同时启动和同时停止，还能根据不同的工作场合调节各个关节的运动速度，使得采用这种技术方案的工业机器人适用于工作节拍不同的生产场合。
为了实现上述目的，采用的技术方案如下：其特征在于，包括以下步骤：
1)求出每个关节即将到达的坐标与刚刚到达的坐标之差，设为DIFi，如果各个关节运动的是第一个步，DIFi就等于每个关节即将到达的坐标值。
2)求出几个关节将要运动的最大距离，设为MaxDistance。
3)计算第一步的计算结果与第二步的计算结果之比，设为V_RATIOi。
4)将一个基速度乘以V_RATIOi作为每一个关节运动的速度，设为Vi。
5)根据不同的速度要求场合，通过按操控面板上的“加速”按钮和“减速”按钮来改变基速度V_Base。
6)通过计算得到的Vi对每一个关节的伺服电机进行调速。
附图说明
图1为一种控制多自由度工业机器人关节启停的方法的计算机程序流程图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
如图1所示：对上述控制系统控制伺服电机转速的方法为：
1)首先执行步骤101，求出每个关节即将到达的坐标与刚刚到达的坐标之差，设为DIFi，
如果各个关节运动的是第一个步，DIFi就等于每个关节即将到达的坐标值。
2)然后执行步骤102，求出几个关节将要运动的最大距离，设为MaxDistance。
3)然后执行步骤103，计算102步的计算结果与103步的计算结果之比，设为V_RATIOi。
4)然后执行步骤104，将一个基速度乘以V_RATIOi作为每一个关节运动的速度，设为Vi。
5)如果要增大各关节的运动速度就执行106a，即按一下操控面板上的“加速”按钮；如果要降低各关节的运动速度就执行106b，即按一下操控面板上的“减速”按钮。
6)将步骤106得到的速度Vi作为每一个关节的伺服电机的运动速度进行调速。
本发明的积极效果在于：1、可以提高工业机器人的工作效率；2、可以让采用这种技术方案的工业机器人工作在对速度要求不同的生产场合；3、使对工业机器人各个关节运动的速度控制变得简便易行。
必须指出，上述实例只是对本发明作出一个非限定性举例说明。但本领域的技术人员会理解，在没有偏离本发明的宗旨和范围下，可以对本发明作出各种修改、替换和变更，这些修改、替换和变更仍属于本发明的保护范围。
Claims (1)
1.一种控制多自由度工业机器人关节运动启停的方法，所述方法其特征在于，包括以下步骤：
1)求出每个关节即将到达的坐标与刚刚到达的坐标之差，设为DIFi，如果各个关节运动的第一个步，DIFi就等于每个关节即将到达的坐标值。
2)求出几个关节将要运动的最大距离，设为MaxDistance。
3)计算第一步的计算结果与第二步的计算结果之比，设为V_RATIOi。
4)将一个基速度乘以V_RATIOi作为每一个关节运动的速度，设为Vi。
5)根据不同的速度要求场合，通过调节操控面板上的“加速”按钮和“减速”按钮来改变基速度V_Base。
6)通过计算得到的Vi对每一个关节的伺服电机进行调速。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2011102081315A CN102886781A (zh) | 2011-07-18 | 2011-07-18 | 一种控制多自由度工业机器人关节运动启停的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2011102081315A CN102886781A (zh) | 2011-07-18 | 2011-07-18 | 一种控制多自由度工业机器人关节运动启停的方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN102886781A true CN102886781A (zh) | 2013-01-23 |
Family
ID=47530563
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2011102081315A Pending CN102886781A (zh) | 2011-07-18 | 2011-07-18 | 一种控制多自由度工业机器人关节运动启停的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102886781A (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108858208A (zh) * | 2018-09-05 | 2018-11-23 | 鲁东大学 | 一种复杂地形仿人机器人自适应平衡控制方法、装置和系统 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6075904A (ja) * | 1983-09-30 | 1985-04-30 | Shin Meiwa Ind Co Ltd | 多関節ロボットの制御のための座標変換方法，演算方法，座標変換装置および演算装置 |
| JPS61143811A (ja) * | 1984-12-18 | 1986-07-01 | Nissan Motor Co Ltd | ロボツトの制御装置 |
| JPS61143813A (ja) * | 1984-12-18 | 1986-07-01 | Nissan Motor Co Ltd | ロボツトの制御装置 |
| EP0442481B1 (en) * | 1990-02-14 | 2001-10-17 | Kawasaki Jukogyo Kabushiki Kaisha | Industrial robot control method and apparatus |
| CN101799660A (zh) * | 2009-02-02 | 2010-08-11 | 卡库机器人有限公司 | 用于操纵器的控制设备和方法 |
| JP2010284758A (ja) * | 2009-06-12 | 2010-12-24 | Seiko Epson Corp | ロボットの制御装置、及びロボットの制御方法 |
-
2011
- 2011-07-18 CN CN2011102081315A patent/CN102886781A/zh active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6075904A (ja) * | 1983-09-30 | 1985-04-30 | Shin Meiwa Ind Co Ltd | 多関節ロボットの制御のための座標変換方法，演算方法，座標変換装置および演算装置 |
| JPS61143811A (ja) * | 1984-12-18 | 1986-07-01 | Nissan Motor Co Ltd | ロボツトの制御装置 |
| JPS61143813A (ja) * | 1984-12-18 | 1986-07-01 | Nissan Motor Co Ltd | ロボツトの制御装置 |
| EP0442481B1 (en) * | 1990-02-14 | 2001-10-17 | Kawasaki Jukogyo Kabushiki Kaisha | Industrial robot control method and apparatus |
| CN101799660A (zh) * | 2009-02-02 | 2010-08-11 | 卡库机器人有限公司 | 用于操纵器的控制设备和方法 |
| JP2010284758A (ja) * | 2009-06-12 | 2010-12-24 | Seiko Epson Corp | ロボットの制御装置、及びロボットの制御方法 |
Non-Patent Citations (1)
| Title |
|---|
| 史孝文: "基于DSP的直流伺服电机控制系统", 《中国优秀博硕士学位论文全文数据库》 * |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108858208A (zh) * | 2018-09-05 | 2018-11-23 | 鲁东大学 | 一种复杂地形仿人机器人自适应平衡控制方法、装置和系统 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106647282A (zh) | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 | |
| CN104786221B (zh) | 一种基于以太网的开放式机械手控制方法 | |
| CN103135501B (zh) | 基于s型曲线的加减速控制方法和装置及数控机床 | |
| CN107160394B (zh) | 一种直线运动模组精确控制方法 | |
| CN106777475B (zh) | 一种有限空间约束的注塑机械臂动力学协同仿真方法 | |
| CN105171743A (zh) | 码垛机械臂末端的运动轨迹规划方法 | |
| CN102799206B (zh) | 臂架末端运动控制方法及系统 | |
| CN102662350A (zh) | 主从式多机器人协作系统的轨迹示教与规划方法 | |
| DE502008002561D1 (de) | Bewegungssteuerung für elastische roboterstrukturen | |
| CN111580453B (zh) | 基于plc的提高二维圆弧插补轨迹精度的实现方法 | |
| CN204366962U (zh) | 六轴重载机器人控制系统 | |
| CN103737592A (zh) | 一种机械手精确控制系统及其方法 | |
| Salmi et al. | Human-robot collaboration and sensor-based robots in industrial applications and construction | |
| CN106346480B (zh) | 一种基于ug和matlab的多自由度注塑机械臂建模方法 | |
| CN103826807A (zh) | 机器人控制方法 | |
| CN201856249U (zh) | 工业机器人运动规划与性能测试系统 | |
| CN106272429B (zh) | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 | |
| CN103737603B (zh) | 一种流水线上机械臂精确控制系统及控制方法 | |
| CN102886781A (zh) | 一种控制多自由度工业机器人关节运动启停的方法 | |
| CN109773778A (zh) | 一种工业机器人关节空间同步运动的规划方法 | |
| CN105415363A (zh) | 位移装置、机器人及机器人奇异点处理方法 | |
| CN102385386A (zh) | 一种水火弯板智能机器人路径规划方法 | |
| CN106873401A (zh) | 一种基于pmac的喷漆机器人控制系统 | |
| CN111376262A (zh) | 机器人离线编程方法 | |
| CN114888796A (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 | ||
| C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130123 |