CN107443375A - 机器人原点标定方法、装置、存储介质和计算机设备 - Google Patents

机器人原点标定方法、装置、存储介质和计算机设备 Download PDF

Info

Publication number
CN107443375A
CN107443375A CN201710597826.4A CN201710597826A CN107443375A CN 107443375 A CN107443375 A CN 107443375A CN 201710597826 A CN201710597826 A CN 201710597826A CN 107443375 A CN107443375 A CN 107443375A
Authority
CN
China
Prior art keywords
joint
coordinates
current
initial
joint coordinates
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
CN201710597826.4A
Other languages
English (en)
Other versions
CN107443375B (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.)
Shenzhen Tongchuan Technology Co Ltd
Original Assignee
Shenzhen Tongchuan 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 Shenzhen Tongchuan Technology Co Ltd filed Critical Shenzhen Tongchuan Technology Co Ltd
Priority to CN201710597826.4A priority Critical patent/CN107443375B/zh
Publication of CN107443375A publication Critical patent/CN107443375A/zh
Application granted granted Critical
Publication of CN107443375B publication Critical patent/CN107443375B/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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明涉及一种机器人原点标定方法、装置、存储介质和计算机设备。所述方法包括:获取机器人各个关节轴初始状态对应的初始关节坐标;根据初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且与参考点重合时关节轴当前状态对应的当前关节坐标;根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;当任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;根据更新后的初始关节坐标更新当前关节坐标,进入根据当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点,不仅能降低成本,而且能提高效率。

Description

机器人原点标定方法、装置、存储介质和计算机设备
技术领域
本发明涉及机器人技术领域,特别是涉及一种机器人原点标定方法、装置、存储介质和计算机设备。
背景技术
机器人是面向工业领域的多关节机械手或多自由度的机器装置,它可以按照预先编排的控制程序执行工作。
机器人在生产时,一般根据其工作范围会对各个关节轴设置一个初始位置,该初始位置即为机器人的机械原点,机械本体实际运动以该机械原点为基准。开发人员控制机械本体运动时需要有一个控制原点,以该控制原点为基准控制机械本体运动。原点标定就是最大精度地将该控制原点调至机械原点。只有当控制原点与实际的机械原点非常接近时,控制机械运动与实际的机械运动才会一致;否则的话,当想控制机器人运动到B点时,由于实际的机械原点与控制人员的坐标原点相差较大,机器人可能没到达B点或者超过B点位置停止,导致机器人的运动精度低。
传统技术中,机器人原点标定方法主要依赖于工具(比如电子控制仪EMD、千分尺),采用这样的方式不仅成本高,而且由于步骤比较繁琐,浪费时间。
发明内容
基于此,有必要针对上述技术问题,提供一种机器人原点标定方法、装置、存储介质和计算机设备,以降低原点标定的成本,同时提高原点标定的效率。
一种机器人原点标定方法,所述方法包括:
获取机器人各个关节轴初始状态对应的初始关节坐标;
根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标;
根据所述当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;
当任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;
根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
在其中一个实施例中,所述采用搜索算法更新初始关节坐标的步骤包括:
将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;
根据当前初始关节坐标计算当前关节坐标;
根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
当各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续增加所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在其中一个实施例中,当各个距离偏差均大于上一次的距离偏差时,所述采用搜索算法更新初始关节坐标的步骤还包括:
将当前第一关节值减少预设偏量,得到当前初始关节坐标;
根据当前初始关节坐标计算当前关节坐标;
根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
当各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续减少所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在其中一个实施例中,所述根据所述当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差的步骤包括:
采用机器人运动学正解算法,将所述当前关节坐标转换为对应的多个笛卡尔坐标;
根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
在其中一个实施例中,所述根据更新后的初始关节坐标更新当前关节坐标的步骤包括:
计算当前关节坐标与更新后的初始关节坐标的差值;
用所述差值替换当前关节坐标。
一种机器人原点标定装置,所述装置包括:
初始关节坐标模块,用于获取机器人各个关节轴初始状态对应的初始关节坐标;
当前关节坐标获取模块,用于根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标;
第一距离偏差计算模块,用于根据所述当前关节坐标获取模块中得到的当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;
初始关节坐标更新模块,用于当所述第一距离偏差计算模块中得到的任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;
原点获取模块,用于根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
在其中一个实施例中,所述初始关节坐标更新模块包括:
预设偏量增加模块,用于将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;
第一当前关节坐标计算模块,用于根据所述预设偏量增加模块中得到的当前初始关节坐标计算当前关节坐标;
第二距离偏差计算模块,用于根据所述第一当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第一目标初始关节值获取模块,用于当所述第二距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续增加所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在其中一个实施例中,当各个距离偏差均大于上一次的距离偏差时,所述初始关节坐标更新模块还包括:
预设偏量减少模块,用于将当前第一关节值减少预设偏量,更新当前初始关节坐标;
第二当前关节坐标计算模块,用于根据所述预设偏量减少模块中得到的当前初始关节坐标计算当前关节坐标;
第三距离偏差计算模块,用于根据所述第二当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第二目标初始关节值获取模块,用于当第三距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续减少所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机可执行指令,所述计算机可执行指令被处理器执行时,使得所述处理器执行上述机器人原点标定方法的步骤。
一种计算机设备,所述计算机设备包括存储器和处理器,所述存储器中储存有计算机可读指令,所述计算机可读指令被所述处理器执行时,使得所述处理器执行上述机器人原点标定方法的步骤。
上述的机器人原点标定方法、装置、存储介质和计算机设备,通过获取机器人各个关节轴初始状态对应的初始关节坐标,根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标,根据所述当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差,判断距离偏差是否小于预设的偏差,当任意两个位置坐标之间的距离偏差大于预设值时,采用搜索算法更新初始关节坐标,根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值,此时的初始关节坐标即为目标初始关节坐标,以该目标初始关节坐标为原点。本发明的技术方案中,不需要依赖于任何工具即可自动进行原点标定,不仅降低了原点标定的成本,同时提高了原点标定的效率。
附图说明
图1为一个实施例中机器人原点标定方法流程图;
图2为另一个实施例中采用搜索算法更新初始关节坐标的流程图;
图3为又一个实施例中采用搜索算法更新初始关节坐标的流程图;
图4为再一个实施例中计算距离偏差的流程图;
图5为再一个实施例中根据更新后的初始关节坐标更新当前关节坐标的流程图;
图6为一个实施例中机器人原点标定装置的结构框图;
图7为又一个实施例中初始关节坐标更新模块的结构框图;
图8为再一个实施例中初始关节坐标更新模块的结构框图;
图9为再一个实施例中第一距离偏差计算模块的结构框图;
图10为再一个实施例中原点获取模块的结构框图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。在下面的描述中阐述了很多具体细节以便于充分理解本发明。但是本发明能够以很多不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似改进,因此本发明不受下面公开的具体实施的限制。
可以理解,本发明所使用的术语“第一”、“第二”等可在本文中用于描述各种元件,但这些元件不受这些术语限制。这些术语仅用于将第一个元件与另一个元件区分。举例来说,在不脱离本发明的范围的情况下,可以将第一客户端称为第二客户端,且类似地,可将第二客户端称为第一客户端。第一客户端和第二客户端两者都是客户端,但其不是同一客户端。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
在一个实施例中,如图1所示,提供了一种机器人原点标定方法,该方法包括:
步骤S110,获取机器人各个关节轴初始状态对应的初始关节坐标。
具体地,机器人关节轴指的是执行操作的各个机械臂,一般由电机驱动其运动。关节坐标,指的是对于机械末端的位置,以各个轴的关节值组成的坐标表示,关节值可能是角度,也可能是位移大小,视该关节轴为旋转轴还是移动轴而定。比如,以四轴机器人为例,第三轴为移动轴,其他为旋转轴,那么其某一时刻的关节坐标可能为(30°,40°,20,50°)。
在一个实施例中,将机器人从机械原点移动一定的位置,将此状态作为原点标定的初始状态,将该状态对应的关节坐标设为初始关节坐标,在初始关节坐标中,各个关节轴对应的关节值全为零。
步骤S120,根据初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且机器人末端与参考点重合时关节轴当前状态对应的当前关节坐标。
具体地,在机器人可达到的范围内预先设定一个参考点,控制机器人以多种不同的姿态分别向该参考点移动,直至机器末端与该参考点重合,记录重合状态下各个关节轴的位置相对于初始状态下的位置变化值,即为关节轴当前状态对应的当前关节坐标。
步骤S130,根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差。
具体地,该位置坐标表示的是机器人末端在三维空间的具体的位置,距离偏差指的是各个位置之间的距离差。
步骤S140,判断各个距离偏差是否均小于预设值。
具体地,预设值指的是可接受范围内的机械运动误差,用于衡量机械运动的精度。
步骤S150,将当前初始坐标作为机器人的原点。
具体地,当任意两个位置坐标之间的距离偏差都小于该预设值时,则说明机械运动的精度满足要求,则该初始关节坐标即为要标定的目标关节坐标,将该目标关节坐标作为控制机器人运动的原点。
步骤S160,采用搜索算法更新初始关节坐标。
步骤S170,根据更新后的初始关节坐标更新当前关节坐标,进入根据当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
具体地,当其中至少一个距离偏差大于该预设值,则说明机械运动的精度不满足要求,此时进入下面的步骤:
1)采用搜索算法更新初始关节坐标;
2)根据更新后的初始关节坐标更新当前关节坐标;
3)根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差,得到当前的距离偏差,将当前距离偏差与预设值进行比较,如果小于预设值,则满足要求,将更新后的初始关节坐标作为原点,如果还是不满足要求,则重复步骤1)-步骤3),直到各个距离偏差均小于预设值时,对应的初始关节坐标即为目标初始关节坐标,也就是机器人的原点。
本实施例中,通过获取机器人各个关节轴初始状态对应的初始关节坐标,根据初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且机器人末端与参考点重合时关节轴当前状态对应的当前关节坐标,根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差,判断距离偏差是否小于预设的偏差,当任意两个位置坐标之间的距离偏差大于预设值时,采用搜索算法更新初始关节坐标,根据更新后的初始关节坐标更新当前关节坐标,进入根据当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值,此时的初始关节坐标即为目标初始关节坐标,以该目标初始关节坐标为原点。本发明的技术方案中,不需要依赖于任何工具即可自动进行原点标定,不仅降低了原点标定的成本,同时提高了原点标定的效率。
在一个实施例中,如图2所示,采用搜索算法更新初始关节坐标的步骤包括:
步骤S160a,将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标。
具体地,预设偏量可根据实际情况自由设定。如,当关节轴为旋转轴时,预设偏量可设为0.1°,关节轴为位移轴时,预设偏量可设为1mm。将第一关节轴对应的关节值(即第一关节值)增加预设偏量后,用增加后的关节值替换上一次的初始关节坐标中该第一关节轴对应的关节值,从而得到当前初始关节坐标。
步骤S160b,根据当前初始关节坐标计算当前关节坐标。
具体地,关节坐标为初始关节坐标的相对坐标,因此当当前的初始关节坐标更新时,当前的关节坐标也发生变化,可将当前关节坐标相应的减少上述预设偏量,记得到当前的关节坐标。
步骤S160c,根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差。
步骤S160d,当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续增加预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的初始关节值。
具体地,将当前的各个距离偏差与上一次的距离偏差进行比较,若当前的距离偏差小于上一次的距离偏差,则进入如下步骤:
(1)将第一关节值在现在的基础上再一次增加预设偏量,用变化后的第一关节值替换现在的第一关节值,得到当前初始关节坐标;
(2)根据当前初始关节坐标计算当前关节坐标;
(3)根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差。将该距离偏差与上一次的距离偏差进行比较,若小于上一次的距离偏差,则重复步骤(1)—步骤(3),直到步骤(3)中的距离偏差均大于上一次的距离偏差时,将上一次的初始关节坐标中第一关节值作为第一关节轴对应的目标初始关节值。
若当前的距离偏差大于上一次的距离偏差,进入下述步骤S160e-步骤S160f。
在一个实施例中,如图3所示,采用搜索算法更新初始关节坐标的步骤还包括:
步骤S160e,将当前第一关节值减少预设偏量,更新当前初始关节坐标。
具体地,将当前第一关节值减少预设偏量后,用减少后的第一关节值替换当前初始关节坐标中的第一关节值从而得到新的当前初始关节坐标。
步骤S160f,根据当前初始关节坐标计算当前关节坐标。
步骤S160g,根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差。
步骤S160h,当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续减少预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的初始关节值。
具体地,将当前的各个距离偏差与上一次的距离偏差进行比较,若当前的距离偏差小于上一次的距离偏差,则进入如下步骤:
(4)将第一关节值在现在的基础上再一次减少预设偏量,用变化后的第一关节值替换现在的第一关节值,得到当前初始关节坐标;
(5)根据当前初始关节坐标计算当前关节坐标;
(6)根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差。将该距离偏差与上一次的距离偏差进行比较,若小于上一次的距离偏差,则重复步骤(4)—步骤(6),直到步骤(6)中的距离偏差均大于上一次的距离偏差时,将上一次的初始关节坐标中第一关节值作为第一关节轴对应的目标初始关节值。
若当前的距离偏差仍然大于上一次的距离偏差,则将当前初始关节坐标重置为初始值,重新设定预设偏量,重复步骤S160a-步骤S160h。
在一个实施例中,在步骤S160d和步骤S160h中,对第一关节值增加或减少预设偏量后,所得到的距离偏差中,有一些大于上一次的距离偏差,另外一些小于上一次的距离偏差,则说明对机器人的示教不准确,此时可重新示教,然后重新开始原点标定。
进一步,将机器人的其他关节轴根据上述步骤依次获取目标初始关节值,即得到目标初始关节坐标,判断该目标初始关节值对应的距离偏差是否均小于预设值,当所有的距离偏差小于,则将该目标初始关节值作为机器人的原点;当其中存在一个距离偏差大于预设值时,根据上述步骤继续更新初始原点,直到各个距离偏差均小于预设值,得到此时对应的标初始关节坐标,将其作为机器人的原点。值得说明的是,每一次更新初始原点时,所设定的预设偏量均小于上一次的预设偏量,使得搜索的精度更高,从而逐渐逼近机械原点,得到最终的目标初始关节坐标。
可以理解,上述步骤S160a-S160h中,还可先执行步骤S160e-S160h,再根据判断结果选择是否执行步骤S160a-S160d。
在一个实施例中,如图4所示,根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差的步骤包括:
步骤S130a,采用机器人运动学正解算法,将当前关节坐标转换为对应的多个笛卡尔坐标。
具体地,正解是指根据机器人的几何参数和关节变量求解末端的位置和姿态,即通过各个轴的关节值求解笛卡尔坐标,其中,笛卡尔坐标系包括空间直角坐标系以及斜角坐标系。
在一个实施例中,正解的步骤包括:1)根据DH法建立机器人机座和连杆坐标系;2)确定DH参数和关节变量;3)从机座出发,逐一确定变换矩阵A;4)将各变换矩阵连乘得到最终变换矩阵,是4*4矩阵,即包含机器人末端位置坐标和姿态的矩阵。
步骤S130b,根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
在一个实施例中,如图5所示,根据更新后的初始关节坐标得到当前关节坐标的步骤包括:
步骤S160i,计算当前关节坐标与更新后的初始关节坐标的差值。
步骤S160j,用差值替换当前关节坐标。
在一个实施例中,如图6所示,还提供一种机器人原点标定装置,包括:
初始关节坐标模块210,用于获取机器人各个关节轴初始状态对应的初始关节坐标;
当前关节坐标获取模块220,用于根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标;
第一距离偏差计算模块230,用于根据所述当前关节坐标获取模块中得到的当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;
初始关节坐标更新模块240,用于当所述第一距离偏差计算模块中得到的任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;
原点获取模块250,用于根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
在一个实施例中,如图7所示,初始关节坐标更新模块240包括:
预设偏量增加模块240a,用于将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;
第一当前关节坐标计算模块240b,用于根据所述预设偏量增加模块中得到的当前初始关节坐标计算当前关节坐标;
第二距离偏差计算模块240c,用于根据所述第一当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第一目标初始关节值获取模块240d,用于当所述第二距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续增加所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,如图8所示,当各个距离偏差均大于上一次的距离偏差时,初始关节坐标更新模块240还包括:
预设偏量减少模块240e,用于将当前第一关节值减少预设偏量,更新当前初始关节坐标;
第二当前关节坐标计算模块240f,用于根据所述预设偏量减少模块中得到的当前初始关节坐标计算当前关节坐标;
第三距离偏差计算模块240g,用于根据所述第二当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第二目标初始关节值获取模块240h,用于当第三距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续减少所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,第一距离偏差计算模块230包括:
坐标转换模块230a,用于采用机器人运动学正解算法,将当前关节坐标转换为对应的多个笛卡尔坐标;
计算模块230b,用于根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
在一个实施例中,原点获取模块250包括:
差值计算模块250a,用于计算当前关节坐标与更新后的初始关节坐标的差值;
替换模块250b,用于用差值替换当前关节坐标。
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,存储器中储存有计算机可读指令,计算机可读指令被处理器执行时,使得处理器执行以下步骤:获取机器人各个关节轴初始状态对应的初始关节坐标;根据初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且机器人末端与参考点重合时关节轴当前状态对应的当前关节坐标;根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;当任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;根据更新后的初始关节坐标更新当前关节坐标,进入根据当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
在一个实施例中,采用搜索算法更新初始关节坐标,包括:将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;根据当前初始关节坐标计算当前关节坐标;根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续增加预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,当各个距离偏差均大于上一次的距离偏差时,采用搜索算法更新初始关节坐标,还包括:将当前第一关节值重置减少预设偏量,更新当前初始关节坐标;根据当前初始关节坐标计算当前关节坐标;根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续减少预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差,包括:采用机器人运动学正解算法,将当前关节坐标转换为对应的多个笛卡尔坐标;根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
在一个实施例中,根据更新后的初始关节坐标更新当前关节坐标,包括:计算当前关节坐标与更新后的初始关节坐标的差值;用差值替换当前关节坐标。
在一个实施例中,提供了一个或多个存储有计算机可读指令的计算机可读存储介质,计算机可读指令被一个或多个处理器执行时,使得一个或多个处理器执行以下步骤:获取机器人各个关节轴初始状态对应的初始关节坐标;根据初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且机器人末端与参考点重合时关节轴当前状态对应的当前关节坐标;根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;当任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;根据更新后的初始关节坐标更新当前关节坐标,进入根据当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
在一个实施例中,采用搜索算法更新初始关节坐标,包括:将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;根据当前初始关节坐标计算当前关节坐标;根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续增加预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,当各个距离偏差均大于上一次的距离偏差时,采用搜索算法更新初始关节坐标,还包括:将当前第一关节值减少预设偏量,得到当前初始关节坐标;根据当前初始关节坐标计算当前关节坐标;根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;当各个距离偏差均小于上一次的距离偏差时,将第一关节值继续减少预设偏量并更新当前初始关节坐标,进入根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
在一个实施例中,根据当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差,包括:采用机器人运动学正解算法,将当前关节坐标转换为对应的多个笛卡尔坐标;根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
在一个实施例中,根据更新后的初始关节坐标更新当前关节坐标,包括:计算当前关节坐标与更新后的初始关节坐标的差值;用差值替换当前关节坐标。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,的程序可存储于一非易失性计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)等。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种机器人原点标定方法,所述方法包括:
获取机器人各个关节轴初始状态对应的初始关节坐标;
根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标;
根据所述当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;
当任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;
根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
2.根据权利要求1所述的方法,其特征在于,所述采用搜索算法更新初始关节坐标的步骤包括:
将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;
根据当前初始关节坐标计算当前关节坐标;
根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
当各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续增加所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
3.根据权利要求2所述的方法,其特征在于,当各个距离偏差均大于上一次的距离偏差时,所述采用搜索算法更新初始关节坐标的步骤还包括:
将当前第一关节值减少预设偏量,更新当前初始关节坐标;
根据当前初始关节坐标计算当前关节坐标;
根据当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
当各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续减少预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
4.根据权利要求1所述的方法,其特征在于,所述根据所述当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差的步骤包括:
采用机器人运动学正解算法,将所述当前关节坐标转换为对应的笛卡尔坐标;
根据计算任意两个笛卡尔坐标之间的距离偏差,其中,(x1,y1,z1)组成其中一个笛卡尔坐标,(x2,y2,z2)组成另一个笛卡尔坐标,e为这两个笛卡尔坐标之间的距离偏差。
5.根据权利要求1所述的方法,其特征在于,所述根据更新后的初始关节坐标更新当前关节坐标的步骤包括:
计算当前关节坐标与更新后的初始关节坐标的差值;
用所述差值替换当前关节坐标。
6.一种机器人原点标定装置,其特征在于,所述装置包括:
初始关节坐标模块,用于获取机器人各个关节轴初始状态对应的初始关节坐标;
当前关节坐标获取模块,用于根据所述初始关节坐标,获取机器人末端分别以多种不同的姿态趋向预设的参考点且所述机器人末端与所述参考点重合时关节轴当前状态对应的当前关节坐标;
第一距离偏差计算模块,用于根据所述当前关节坐标获取模块中得到的当前关节坐标得到各个姿态下对应的位置坐标,并计算各个位置坐标两两之间的距离偏差;
初始关节坐标更新模块,用于当所述第一距离偏差计算模块中得到的任意一个距离偏差大于预设值时,采用搜索算法更新初始关节坐标;
原点获取模块,用于根据更新后的初始关节坐标更新当前关节坐标,进入所述根据所述当前关节坐标得到各个姿态下对应的位置坐标的步骤,直至各个距离偏差均小于预设值时,获取对应的目标初始关节坐标作为机器人的原点。
7.根据权利要求6所述的装置,其特征在于,所述初始关节坐标更新模块包括:
预设偏量增加模块,用于将机器人的第一关节轴对应的第一关节值增加预设偏量,得到当前初始关节坐标;
第一当前关节坐标计算模块,用于根据所述预设偏量增加模块中得到的当前初始关节坐标计算当前关节坐标;
第二距离偏差计算模块,用于根据所述第一当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第一目标初始关节值获取模块,用于当所述第二距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续增加所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
8.根据权利要求7所述的装置,其特征在于,当各个距离偏差均大于上一次的距离偏差时,所述初始关节坐标更新模块还包括:
预设偏量减少模块,用于将当前第一关节值减少预设偏量,更新当前初始关节坐标;
第二当前关节坐标计算模块,用于根据所述预设偏量减少模块中得到的当前初始关节坐标计算当前关节坐标;
第三距离偏差计算模块,用于根据所述第二当前关节坐标计算模块中得到的当前关节坐标得到当前位置坐标,并计算各个位置坐标两两之间的距离偏差;
第二目标初始关节值获取模块,用于当第三距离偏差计算模块中得到的各个距离偏差均小于上一次的距离偏差时,将所述第一关节值继续减少所述预设偏量并更新当前初始关节坐标,进入所述根据当前初始关节坐标计算当前关节坐标的步骤,直至各个距离偏差均大于上一次的距离偏差时,将上一次对应的第一关节值作为第一关节轴对应的目标初始关节值。
9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机可执行指令,所述计算机可执行指令被处理器执行时,使得所述处理器执行权利要求1至5中任一项所述方法的步骤。
10.一种计算机设备,其特征在于,包括存储器和处理器,所述存储器中储存有计算机可读指令,所述计算机可读指令被所述处理器执行时,使得所述处理器执行权利要求1至5中任一项所述的方法的步骤。
CN201710597826.4A 2017-07-20 2017-07-20 机器人原点标定方法、装置、存储介质和计算机设备 Active CN107443375B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710597826.4A CN107443375B (zh) 2017-07-20 2017-07-20 机器人原点标定方法、装置、存储介质和计算机设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710597826.4A CN107443375B (zh) 2017-07-20 2017-07-20 机器人原点标定方法、装置、存储介质和计算机设备

Publications (2)

Publication Number Publication Date
CN107443375A true CN107443375A (zh) 2017-12-08
CN107443375B CN107443375B (zh) 2019-11-05

Family

ID=60488963

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710597826.4A Active CN107443375B (zh) 2017-07-20 2017-07-20 机器人原点标定方法、装置、存储介质和计算机设备

Country Status (1)

Country Link
CN (1) CN107443375B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108272513A (zh) * 2018-01-26 2018-07-13 珠海市俊凯机械科技有限公司 临床定位方法、装置、计算机设备和存储介质
CN108297100A (zh) * 2018-02-11 2018-07-20 广州视源电子科技股份有限公司 机械臂参数标定方法、装置和系统、机械臂
CN108466266A (zh) * 2018-03-22 2018-08-31 山东农业大学 机械臂运动控制方法及系统
CN108908335A (zh) * 2018-07-20 2018-11-30 合肥工业大学 基于改进差分进化算法的机器人标定方法
CN109366472A (zh) * 2018-12-04 2019-02-22 广东拓斯达科技股份有限公司 机器人的物品放置方法、装置、计算机设备及存储介质
CN109807891A (zh) * 2019-01-31 2019-05-28 北京华航唯实机器人科技股份有限公司 设备运动处理方法及装置
CN110315530A (zh) * 2018-03-30 2019-10-11 日本电产株式会社 校准精度的评价方法和评价装置
CN112706008A (zh) * 2021-01-06 2021-04-27 广东博智林机器人有限公司 一种天花打磨方法及装置
CN113712672A (zh) * 2021-11-04 2021-11-30 极限人工智能(北京)有限公司 一种原点位置校准方法、装置、电子设备及存储介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001038662A (ja) * 1999-08-04 2001-02-13 Honda Motor Co Ltd 作業ロボットの校正方法
CN102294695A (zh) * 2010-06-25 2011-12-28 鸿富锦精密工业(深圳)有限公司 机器人标定方法及标定系统
KR20120035632A (ko) * 2010-10-06 2012-04-16 삼성중공업 주식회사 다관절 로봇의 원점 세팅 방법
CN103395073A (zh) * 2013-08-22 2013-11-20 中国船舶重工集团公司第七一六研究所 一种六轴工业机器人的零点标定方法
CN104827480A (zh) * 2014-02-11 2015-08-12 泰科电子(上海)有限公司 机器人系统的自动标定方法
JP2015147280A (ja) * 2014-02-07 2015-08-20 キヤノン株式会社 ロボット較正方法
CN105196311A (zh) * 2015-10-21 2015-12-30 国机集团科学技术研究院有限公司 一种六轴机器人的零点快速标定方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001038662A (ja) * 1999-08-04 2001-02-13 Honda Motor Co Ltd 作業ロボットの校正方法
CN102294695A (zh) * 2010-06-25 2011-12-28 鸿富锦精密工业(深圳)有限公司 机器人标定方法及标定系统
KR20120035632A (ko) * 2010-10-06 2012-04-16 삼성중공업 주식회사 다관절 로봇의 원점 세팅 방법
CN103395073A (zh) * 2013-08-22 2013-11-20 中国船舶重工集团公司第七一六研究所 一种六轴工业机器人的零点标定方法
JP2015147280A (ja) * 2014-02-07 2015-08-20 キヤノン株式会社 ロボット較正方法
CN104827480A (zh) * 2014-02-11 2015-08-12 泰科电子(上海)有限公司 机器人系统的自动标定方法
CN105196311A (zh) * 2015-10-21 2015-12-30 国机集团科学技术研究院有限公司 一种六轴机器人的零点快速标定方法

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108272513A (zh) * 2018-01-26 2018-07-13 珠海市俊凯机械科技有限公司 临床定位方法、装置、计算机设备和存储介质
CN108297100A (zh) * 2018-02-11 2018-07-20 广州视源电子科技股份有限公司 机械臂参数标定方法、装置和系统、机械臂
CN108297100B (zh) * 2018-02-11 2023-08-15 广州视源电子科技股份有限公司 机械臂参数标定方法、装置和系统、机械臂
CN108466266A (zh) * 2018-03-22 2018-08-31 山东农业大学 机械臂运动控制方法及系统
CN110315530A (zh) * 2018-03-30 2019-10-11 日本电产株式会社 校准精度的评价方法和评价装置
CN110315530B (zh) * 2018-03-30 2023-08-22 日本电产株式会社 校准精度的评价方法和评价装置
CN108908335A (zh) * 2018-07-20 2018-11-30 合肥工业大学 基于改进差分进化算法的机器人标定方法
CN108908335B (zh) * 2018-07-20 2023-03-14 合肥工业大学 基于改进差分进化算法的机器人标定方法
CN109366472B (zh) * 2018-12-04 2020-11-27 广东拓斯达科技股份有限公司 机器人的物品放置方法、装置、计算机设备及存储介质
CN109366472A (zh) * 2018-12-04 2019-02-22 广东拓斯达科技股份有限公司 机器人的物品放置方法、装置、计算机设备及存储介质
CN109807891B (zh) * 2019-01-31 2020-02-07 北京华航唯实机器人科技股份有限公司 设备运动处理方法及装置
CN109807891A (zh) * 2019-01-31 2019-05-28 北京华航唯实机器人科技股份有限公司 设备运动处理方法及装置
CN112706008A (zh) * 2021-01-06 2021-04-27 广东博智林机器人有限公司 一种天花打磨方法及装置
CN112706008B (zh) * 2021-01-06 2022-03-01 广东博智林机器人有限公司 一种天花打磨方法及装置
CN113712672A (zh) * 2021-11-04 2021-11-30 极限人工智能(北京)有限公司 一种原点位置校准方法、装置、电子设备及存储介质

Also Published As

Publication number Publication date
CN107443375B (zh) 2019-11-05

Similar Documents

Publication Publication Date Title
CN107443375A (zh) 机器人原点标定方法、装置、存储介质和计算机设备
US7859540B2 (en) Reconstruction, retargetting, tracking, and estimation of motion for articulated systems
Zhao et al. An efficient error compensation method for coordinated CNC five-axis machine tools
US8467904B2 (en) Reconstruction, retargetting, tracking, and estimation of pose of articulated systems
WO2012063397A1 (ja) 移動経路探索装置および移動経路探索方法
Huang et al. Identification of two different geometric error definitions for the rotary axis of the 5-axis machine tools
CN113510698B (zh) 一种机械臂控制方法、装置、机械臂和可读存储介质
US20240342903A1 (en) Method and system for autonomous object manipulation
CN112767493B (zh) Stewart平台运动学参数的机器视觉标定方法
KR20170016631A (ko) 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체
JP3349652B2 (ja) オフラインティーチング方法
US10507585B2 (en) Robot system that displays speed
CN103906606B (zh) 运动学校准方法
Brandstötter Adaptable serial manipulators in modular design
US20220066401A1 (en) Machine control system
JP5398981B2 (ja) 荷物相互間の相対的な移動を制御するためのシステム
Xi A comparison study on hexapods with fixed-length legs
CN117621041A (zh) 生成机器人的动作路径的装置、方法以及记录介质
CN114454180B (zh) 移动机器人的运动控制方法、装置和移动机器人
Mousavi Mohammadi et al. A real-time impedance-based singularity and joint-limits avoidance approach for manual guidance of industrial robots
CN114193436B (zh) 一种机器人工作空间优化方法、装置、存储介质和设备
Krakhmalev et al. Methods of calibrating the orientation of the industrial robot tool
CN112847441B (zh) 基于梯度下降法的六轴机器人坐标偏移检测方法和装置
JP2005157784A (ja) 小型アーティファクトを用いた運動機構の校正方法
Szep et al. Kinematics, workspace, design and accuracy analysis of RPRPR medical parallel robot

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