CN109648563A - 串联机器人运动控制方法及计算机存储介质 - Google Patents

串联机器人运动控制方法及计算机存储介质 Download PDF

Info

Publication number
CN109648563A
CN109648563A CN201910001011.4A CN201910001011A CN109648563A CN 109648563 A CN109648563 A CN 109648563A CN 201910001011 A CN201910001011 A CN 201910001011A CN 109648563 A CN109648563 A CN 109648563A
Authority
CN
China
Prior art keywords
artis
control method
robot
plane
joint
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
CN201910001011.4A
Other languages
English (en)
Other versions
CN109648563B (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.)
Nanjing Post and Telecommunication University
Nanjing University of Posts and Telecommunications
Original Assignee
Nanjing Post and Telecommunication University
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 Nanjing Post and Telecommunication University filed Critical Nanjing Post and Telecommunication University
Priority to CN201910001011.4A priority Critical patent/CN109648563B/zh
Publication of CN109648563A publication Critical patent/CN109648563A/zh
Application granted granted Critical
Publication of CN109648563B publication Critical patent/CN109648563B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/1612—Programme controls characterised by the hand, wrist, grip 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/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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种串联机器人运动控制方法及计算机存储介质，所述的控制方法是根据机器人的末端点和关节点位置信息去控制机器人达到目标点位置，包括步骤：(1)建立全局坐标系并确定目标点位置信息；(2)获取末端点和关节点的位置信息；(3)计算各关节点所需角度信息；(4)采用PID方式分别控制各关节电机往目标方向转动；(5)检测末端和目标点之间的距离是否到达允许误差范围内，如果达到则停止转动，如果没有则回到步骤(2)执行。本方法克服了目前机器人控制方法中求解繁琐、控制效率低等问题，能够有效的降低运算和控制的复杂度，减轻控制器的负担。

Description

串联机器人运动控制方法及计算机存储介质
技术领域
本发明涉及一种串联机器人运动控制方法及计算机存储介质，特别是涉及一种基于关节位置信息感知的串联机器人运动控制方法及计算机存储介质。
背景技术
当前机器人被广泛应用到人类生产生活的各个方面，随着机器人的普及，对机器人的性能要求也越来越高。性能的提高主要体现在灵活度和快速性。现有的机器人控制方法常基于D-H运动学模型，建立运动学的矩阵方程，然后把关节变量分离出来，从而求解。分离变量的求解过程随着自由度的增加而迅速变得极其复杂，计算量极大，无法克服多解问题，严重阻碍了机器人的实时性能和执行任务的效率。另一种常用方法是迭代求解，该方法的速度取决于迭代速度，精确度取决于迭代步长，实际使用中效果常常不理想，求解速度慢。
因此，目前亟需一种简单易操作的机器人控制方法，用与解决现有技术中的机器人控制方法存在的控制效率较低，求解过程过于繁琐的问题。
发明内容
发明目的：本发明要解决的技术问题是提供一种串联机器人运动控制方法及计算机存储介质，克服了目前机器人控制方法中求解繁琐、控制效率低等问题，能够有效的降低运算和控制的复杂度，减轻控制器的负担。
技术方案：本发明所述的串联机器人运动控制方法，根据机器人的末端点和关节点位置信息去控制机器人达到目标点位置，包括步骤：
(1)建立全局坐标系并确定目标点位置信息；
(2)获取末端点和关节点的位置信息；
(3)计算各关节点所需角度信息；
(4)采用PID方式分别控制各关节电机往目标方向转动；
(5)检测末端和目标点之间的距离是否到达允许误差范围内，如果达到则停止转动，如果没有则回到步骤(2)执行。
进一步的，所述步骤(1)具体包括以下步骤：
(1.1)以机器人的第一个关节点为坐标原点建立三维全局坐标系，Z轴垂直于机器人底座向上，X轴和Y轴根据右手法则确定，正视图为Z轴和Y轴形成的平面图；
(1.2)根据目标点的位置信息确定其在全局坐标系中的坐标(xo，yo，zo)。
进一步的，所述步骤(2)的位置信息为末端点和关节点在全局坐标系中的坐标。
进一步的，所述步骤(3)具体包括以下步骤：
(3.1)计算关节点转动轴延长线与XY平面的夹角A，与ZY平面的夹角B，与XZ平面夹角C，选择A、B、C中角度最大夹角所对应的平面为参照平面，如果A＝B＝C则选择XY平面为参照平面；
(3.2)计算关节点和目标点连线在参照平面上的投影形成的向量[xn，yn]，计算关节点和末端点连线在参照平面上的投影形成的向量[x′n，y′n]；
(3.3)计算上述两向量之间的夹角θn(t)。
进一步的，所述步骤(4)具体包括以下步骤：
(4.1)确定关节点电机的转动方向，从第一个关节到最后一个关节根据步骤(3)所求得的夹角θn(t)转动，转动方法为：若满足yn×x′n-y′n×xn＜0，转动方向为在所述参照平面上的投影顺时针转动，若不满足则转动方向为在所述参照平面上的投影逆时针转动；
(4.2)确定关节点电机的转动角速度，角速度大小由下述公式确定：
其中Kp、Ki、Kd分别为比例、积分、微分系数；
(4.3)关节点电机按照上述的转动方向和角速度进行转动，转动的控制周期为Δt。
进一步的，所述步骤(5)具体包括以下步骤：
(5.1)获取末端点的坐标并计算末端点到目标点的平方距离：
L＝(X-xo)2+(Y-yo)2+(Z-zo)2，
其中(X,Y,Z)为末端点的坐标，(xo，yo，zo)为目标点的坐标；
(5.2)设定误差允许大小ε，ε根据实际工作中要求的位置精度进行设定；
(5.3)若L小于等于ε则停止转动，否则回到步骤(2)继续执行。
本发明所述的计算机存储介质，其上存储有计算机程序，所述程序被计算机处理器执行时实现上述的方法。
有益效果：本方法能够有效地降低机器人运动控制方法中的复杂度，彻底避免多解问题，提高处理的实时性，减轻了控制器的负担。
附图说明
图1是本方法的整体流程图；
图2是三自由度串联机械臂初始位姿及全局坐标系图；
图3是关节1的投影向量和角度图；
图4是关节2的投影向量和角度图；
图5是关节1、2、3的运动方向和距离检测图。
具体实施方式
本实施例以三自由度串联机械臂为例，通过关节位置信息感知来实现对该机器人点位运动的控制，本方法具体实施步骤如如图1所示。
(1)建立全局坐标系：
(1.1)以第一个关节点为坐标原点开始建立串联机器人的三维全局坐标系，Z轴垂直于机器人底座向上，X轴和Y轴根据右手法则确定，正视图为Z轴和Y轴形成的平面图；
(1.2)根据目标点的位置信息确定其在全局坐标系中的坐标(xo，yo，zo)；
如图2所示，为建立的三自由度串联机械臂初始位姿图及全局坐标系，坐标系的原点为关节1的关节点，关节1的旋转轴垂直于地面，关节点2、3的旋转轴平行于XY平面，但不与YZ平面垂直，小球为目标点，坐标即为(xo，yo，zo)。
(2)获取关节位置信息；
(2.1)获取末端点的位置，各关节点的高度和转动角度；
(2.2)确定末端点在全局坐标系中的坐标(xw，yw，zw)，图2中已经指明了末端点；
(2.3)确定各关节在全局坐标系中的坐标，关节点1的坐标为(0,0,0),关节点2为(x2，y2，z2)，关节点3为(x3，y3，z3)，关节坐标矩阵为:
(3)计算各关节所需角度信息；
(3.1)如图3和图4所示，本实施方式中的机器人关节较少，默认目标点坐标中的y0不等于0，选择XY和YZ这两个投影面即可满足工作要求，如果y0等于0，把YZ平面换成XZ平面即可。计算关节1和目标点连线在XY平面上的投影形成的向量，计算关节2和目标点连线在ZY平面上的投影形成的向量，关节3和目标点在ZY平面的投影形成的向量，得：
(3.2)如图3、4所示，计算关节1和末端点连线在XY平面上的投影形成的向量，计算关节2和末端点连线在ZY平面上的投影形成的向量，关节3和目标点在ZY平面的投影形成的向量，得：
(3.3)计算两向量之间的夹角θn(t)，所求角度的位置已在图3、4中标出，关节1、2、3的所求角度为：
(4)如图5所示，采用PID方式控制电机同时往目标方向转动；
(4.1)图5中关节1、2、3的转动方向为
式中对应的d小于0则顺时针转动，不满足则逆时针转动，如图5中箭头所指方向；
(4.2)关节1、2、3电机开始按所求得的方向转动；
关节速度大小采用PID控制，速度大小由下述公式确定：
式中Kp、Ki、Kd分别为比例、积分、微分系数，具体数值由操作人员根据实际控制系统设置；
转动的控制周期为Δt，Δt根据机器人实际作业时的情况设置，在实际作业时可以安排每隔10ms或者更长时间检测一次，只要这个控制周期Δt大于机器人的控制指令周期即可。
(5)检测末端位置和目标位置的距离，在图5中已标出，判断是否到达允许误差范围内，如果没有则回到步骤(2)；
(5.1)设定误差允许大小ε，误差范围即为±ε，ε等于实际工作中要求的位置精度；
(5.2)在机器人的运动过程中，每个控制周期测量末端点位置并计算一次末端点到目标点的平方距离L＝(X-xo)2+(Y-yo)2+(Z-zo)2，如果小于等于n则停止转动；否则，回到上述步骤(2)。
本发明的实施例还提供了一种计算机存储介质，其上存储有计算机程序。当所述计算机程序由处理器执行时，可以实现前述控制的方法。例如，该计算机存储介质为计算机可读存储介质。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。

Claims (7)

1.一种串联机器人运动控制方法，其特征在于：所述的控制方法是根据机器人的末端点和关节点位置信息去控制机器人达到目标点位置，包括步骤：
(1)建立全局坐标系并确定目标点位置信息；
(2)获取末端点和关节点的位置信息；
(3)计算各关节点所需角度信息；
(4)采用PID方式分别控制各关节电机往目标方向转动；
(5)检测末端和目标点之间的距离是否到达允许误差范围内，如果达到则停止转动，如果没有则回到步骤(2)执行。
2.根据权利要求1所述的串联机器人运动控制方法，其特征在于所述步骤(1)具体包括以下步骤：
(1.1)以机器人的第一个关节点为坐标原点建立三维全局坐标系，Z轴垂直于机器人底座向上，X轴和Y轴根据右手法则确定，正视图为Z轴和Y轴形成的平面图；
(1.2)根据目标点的位置信息确定其在全局坐标系中的坐标(xo，yo，zo)。
3.根据权利要求1所述的串联机器人运动控制方法，其特征在于所述步骤(2)的位置信息为末端点和关节点在全局坐标系中的坐标。
4.根据权利要求1所述的串联机器人运动控制方法，其特征在于所述步骤(3)具体包括以下步骤：
(3.1)计算关节点转动轴延长线与XY平面的夹角A，与ZY平面的夹角B，与XZ平面夹角C，选择A、B、C中角度最大夹角所对应的平面为参照平面，如果A＝B＝C则选择XY平面为参照平面；
(3.2)计算关节点和目标点连线在参照平面上的投影形成的向量[xn，yn]，计算关节点和末端点连线在参照平面上的投影形成的向量[x′n，y′n]；
(3.3)计算上述两向量之间的夹角θn(t)。
5.根据权利要求4所述的串联机器人运动控制方法，其特征在于所述步骤(4)具体包括以下步骤：
(4.1)确定关节点电机的转动方向，从第一个关节到最后一个关节根据步骤(3)所求得的夹角θn(t)转动，转动方法为：若满足yn×x′n-y′n×xn＜0，转动方向为在所述参照平面上的投影顺时针转动，若不满足则转动方向为在所述参照平面上的投影逆时针转动；
(4.2)确定关节点电机的转动角速度，角速度大小由下述公式确定：
其中Kp、Ki、Kd分别为比例、积分、微分系数；
(4.3)关节点电机按照上述的转动方向和角速度进行转动，转动的控制周期为Δt。
6.根据权利要求5所述的串联机器人运动控制方法，其特征在于所述步骤(5)具体包括以下步骤：
(5.1)获取末端点的坐标并计算末端点到目标点的平方距离：
L＝(X-xo)2+(Y-yo)2+(Z-zo)2，
其中(X，Y，Z)为末端点的坐标，(xo，yo，zo)为目标点的坐标；
(5.2)设定误差允许大小ε，ε根据实际工作中要求的位置精度进行设定；
(5.3)若L小于等于ε则停止转动，否则回到步骤(2)继续执行。
7.一种计算机存储介质，其上存储有计算机程序，其特征在于：所述程序被计算机处理器执行时实现权利要求1至6任一项所述的方法。
CN201910001011.4A 2019-01-02 2019-01-02 串联机器人运动控制方法及计算机存储介质 Active CN109648563B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910001011.4A CN109648563B (zh) 2019-01-02 2019-01-02 串联机器人运动控制方法及计算机存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910001011.4A CN109648563B (zh) 2019-01-02 2019-01-02 串联机器人运动控制方法及计算机存储介质

Publications (2)

Publication Number Publication Date
CN109648563A true CN109648563A (zh) 2019-04-19
CN109648563B CN109648563B (zh) 2021-10-29

Family

ID=66117042

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910001011.4A Active CN109648563B (zh) 2019-01-02 2019-01-02 串联机器人运动控制方法及计算机存储介质

Country Status (1)

Country Link
CN (1) CN109648563B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114290331A (zh) * 2021-12-14 2022-04-08 中国科学院深圳先进技术研究院 机器人运动控制方法、机器人及计算机可读存储装置
CN115709464A (zh) * 2022-11-22 2023-02-24 遨天科技(北京)有限公司 一种微装配动作执行机构及精度补偿方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101726296A (zh) * 2009-12-22 2010-06-09 哈尔滨工业大学 空间机器人视觉测量、路径规划、gnc一体化仿真系统
CN103692440A (zh) * 2013-12-06 2014-04-02 中国民航大学 一种连续型机器人空间路径跟踪方法
CN105005656A (zh) * 2015-07-13 2015-10-28 广州霞光技研有限公司 一种6自由度机械手自主抓取逆解工程算法
CN105700527A (zh) * 2016-01-26 2016-06-22 哈尔滨工业大学 一种平面冗余度机器人避障及避奇异的路径规划方法
CN106041932A (zh) * 2016-07-01 2016-10-26 广东工业大学 一种ur机器人的运动控制方法
US20170165841A1 (en) * 2015-12-10 2017-06-15 Fanuc Corporation Robot system equipped with video display apparatus that displays image of virtual object in superimposed fashion on real image of robot
US20170232613A1 (en) * 2013-11-01 2017-08-17 Brain Corporation Apparatus and methods for haptic training of robots
KR20170129496A (ko) * 2016-05-17 2017-11-27 엘지전자 주식회사 이동 로봇
CN107953340A (zh) * 2018-01-16 2018-04-24 广东凯宝机器人科技有限公司 一种通用型六自由度机械手逆解工程算法
CN108453727A (zh) * 2018-01-11 2018-08-28 中国人民解放军63920部队 基于椭圆特征的机械臂末端位姿误差校正方法及系统

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101726296A (zh) * 2009-12-22 2010-06-09 哈尔滨工业大学 空间机器人视觉测量、路径规划、gnc一体化仿真系统
US20170232613A1 (en) * 2013-11-01 2017-08-17 Brain Corporation Apparatus and methods for haptic training of robots
CN103692440A (zh) * 2013-12-06 2014-04-02 中国民航大学 一种连续型机器人空间路径跟踪方法
CN105005656A (zh) * 2015-07-13 2015-10-28 广州霞光技研有限公司 一种6自由度机械手自主抓取逆解工程算法
US20170165841A1 (en) * 2015-12-10 2017-06-15 Fanuc Corporation Robot system equipped with video display apparatus that displays image of virtual object in superimposed fashion on real image of robot
CN105700527A (zh) * 2016-01-26 2016-06-22 哈尔滨工业大学 一种平面冗余度机器人避障及避奇异的路径规划方法
KR20170129496A (ko) * 2016-05-17 2017-11-27 엘지전자 주식회사 이동 로봇
CN106041932A (zh) * 2016-07-01 2016-10-26 广东工业大学 一种ur机器人的运动控制方法
CN108453727A (zh) * 2018-01-11 2018-08-28 中国人民解放军63920部队 基于椭圆特征的机械臂末端位姿误差校正方法及系统
CN107953340A (zh) * 2018-01-16 2018-04-24 广东凯宝机器人科技有限公司 一种通用型六自由度机械手逆解工程算法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
ABBASALI DEHGHAN TEZERJANI: "4-DOF Pose Estimation of a Pipe Crawling Robot using a Collimated Laser, a Conic Mirror, and a Fish-eye Camera", 《2014 SOUTHWEST SYMPOSIUM ON IMAGE ANALYSIS AND INTERPRETATION 》 *
OLATUNJI MUMINI OMISORE: "Non-iterative geometric approach for inverse kinematics of redundant lead‑module in a radiosurgical snake‑like robot", 《BIOMEDICAL ENGINEERING》 *
王鹏: "6R机器人的运动规划与仿真研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114290331A (zh) * 2021-12-14 2022-04-08 中国科学院深圳先进技术研究院 机器人运动控制方法、机器人及计算机可读存储装置
CN115709464A (zh) * 2022-11-22 2023-02-24 遨天科技(北京)有限公司 一种微装配动作执行机构及精度补偿方法

Also Published As

Publication number Publication date
CN109648563B (zh) 2021-10-29

Similar Documents

Publication Publication Date Title
US10207406B2 (en) Robot trajectory generation method, robot trajectory generation apparatus, product fabrication method, recording medium, program, and robot system
US8831777B2 (en) Robot program changing device
US9827675B2 (en) Collision avoidance method, control device, and program
CN105353725B (zh) 用于工业机器人的过辅助点姿态空间圆弧插补方法
US20070242073A1 (en) Robot simulation apparatus
CN109648563A (zh) 串联机器人运动控制方法及计算机存储介质
WO2024037658A1 (zh) 机器人指向动作控制方法、装置、电子设备和存储介质
US7957834B2 (en) Method for calculating rotation center point and axis of rotation, method for generating program, method for moving manipulator and positioning device, and robotic system
CN109311155B (zh) 一种工业机器人的工具坐标系原点的标定方法及装置
WO2020010628A1 (zh) 变位机轴坐标系标定方法、机器人系统及存储装置
CN107520838B (zh) 机械手臂及其控制方法和装置
US11654562B2 (en) Apparatus, robot control device, robot system, and method of setting robot coordinate system
WO2020133882A1 (zh) 一种机器人应用于再现机加工的方法
JP2000039911A (ja) ロボット制御装置
CN108858162B (zh) 四轴机械臂的位置确定方法和装置
RU2756437C1 (ru) Способ и система планирования движения робота-манипулятора путем коррекции опорных траекторий
CN113459103B (zh) 一种机械手自动运行时的转角轨迹控制方法及装置
CN113442145B (zh) 欠约束下的最优位姿确定方法、装置、存储介质及机械臂
WO2023013739A1 (ja) ロボット制御装置、ロボット制御システム、及びロボット制御方法
EP4382258A1 (en) Robot control device, robot control system, and robot control method
CN109129558A (zh) 一种控制机械臂末端执行空间曲线动作的方法
CN113942016B (zh) 一种机械臂末端运动位姿时间同步方法
WO2021062694A1 (zh) 控制机器人的方法、装置、系统、存储介质和终端
EA040444B1 (ru) Способ и система планирования движения робота-манипулятора путем коррекции опорных траекторий
JP2024027266A (ja) 制御方法およびロボットシステム

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