CN112706164A - 机械臂初始位姿自动矫正方法、装置、设备及存储介质 - Google Patents
机械臂初始位姿自动矫正方法、装置、设备及存储介质 Download PDFInfo
- Publication number
- CN112706164A CN112706164A CN202011504661.XA CN202011504661A CN112706164A CN 112706164 A CN112706164 A CN 112706164A CN 202011504661 A CN202011504661 A CN 202011504661A CN 112706164 A CN112706164 A CN 112706164A
- Authority
- CN
- China
- Prior art keywords
- arm
- mechanical arm
- joint sub
- steering engine
- deviation angle
- 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
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/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
Abstract
本发明公开了一种机械臂初始位姿自动矫正方法、装置、设备及存储介质,该机械臂初始位姿自动矫正方法包括:S1:获取机械臂的图像;S2:对所述图像进行图像处理,计算得到所述机械臂各个关节子臂的偏差角度;S3:判断各关节子臂的偏差角度是否超出对应的预设阈值;S4:若是,则控制超出对应预设阈值的关节子臂所对应的舵机动作,以调整关节子臂的初始位置,并在调整后返回步骤S1;S5:若否,则结束。通过获取机械臂的图像并进行图像处理,得到机械臂各关节子臂的偏差角度,将各关节子臂的偏差角度与对应的预设阈值做比较,自动控制超出对应预设阈值的关节子臂的舵机动作,自动矫正各关节子臂的初始位姿,提高了机械臂位姿的矫正精度。
Description
技术领域
本发明涉及机械臂技术领域,更具体地说,涉及一种机械臂初始位姿自动矫正方法、装置、设备及存储介质。
背景技术
现有技术中,通常通过人眼观察机械臂的初始位置,并人为判断机械臂的初始位置是否正确,例如,通过人眼目测来估计机械臂是否处于竖直状态。
当人为判断机械臂的初始位姿存在偏差时,人工利用工具来矫正机械臂的位置。显然,这种人为矫正机械臂位姿的方式,精确度低,机械臂复位准确性差。
因此,如何提高机械臂初始位姿矫正的精确性,确保机械臂复位的准确性,是目前本领域技术人员亟待解决的问题。
发明内容
有鉴于此,本发明的目的是提供一种机械臂初始位姿自动矫正方法,以提高机械臂初始位姿矫正的精确性,确保机械臂复位的准确性。
本发明的另一目的是提供一种机械臂初始位姿自动矫正装置、设备及存储介质,均具有上述有益效果。
为了实现上述目的,本发明提供如下技术方案:
一种机械臂初始位姿自动矫正方法,包括:
S1:获取机械臂的图像;
S2:对所述图像进行图像处理,计算得到所述机械臂各个关节子臂的偏差角度,其中,所述机械臂包括至少一个所述关节子臂;
S3:判断各个所述关节子臂的偏差角度是否超出对应的预设阈值;
S4:若是,则控制超出对应预设阈值的所述关节子臂所对应的舵机动作,以调整所述关节子臂的初始位置,并在调整后返回步骤S1;
S5:若否,则结束。
优选地,所述关节子臂的数量为至少两个,得到所述机械臂各个关节子臂的偏差角度的过程,包括:
根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标以及所述机械臂末端的法兰中心点的位置坐标;
根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于所述机械臂末端的舵机的旋转轴心点的位置坐标与所述法兰中心点的位置坐标,计算位于所述机械臂末端的舵机的旋转轴心点与所述法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个所述关节子臂的偏差角度。
优选地,在获取机械臂的图像之前,还包括:
在各个所述关节子臂的旋转关节处设置标识点,所述标识点与对应的舵机的旋转轴心点之间具有确定的位置关系;
根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标的过程中,包括:
以所述标识点为基准点,并根据所述标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
优选地,在控制超出对应预设阈值的所述关节子臂所对应的舵机动作之前,还包括:
根据超出对应预设阈值的所述关节子臂的偏差角度,计算与所述关节子臂对应的舵机的矫正步数;
其中,控制超出对应预设阈值的所述关节子臂所对应的舵机动作,包括:
控制超出对应预设阈值的所述关节子臂对应的舵机转动所述矫正步数。
一种机械臂初始位姿自动矫正装置,包括:
图像采集模块,用于获取机械臂的图像;
偏差角度计算模块,用于对所述图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,其中,所述机械臂包括至少一个所述关节子臂;
判断模块,用于判断各个所述关节子臂的偏差角度是否超出对应的预设阈值;
位姿矫正模块,用于当所述关节子臂的偏差角度超出对应的预设阈值时,则控制超出对应预设阈值的所述关节子臂所对应的舵机动作,以调整所述关节子臂的初始位置。
优选地,所述偏差角度计算模块包括:
位置坐标获取模块,用于根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标以及所述机械臂末端的法兰中心点的位置坐标;
计算模块,用于根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于所述机械臂末端的舵机的旋转轴心点的位置坐标与所述法兰中心点的位置坐标,计算位于所述机械臂末端的舵机的旋转轴心点与所述法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个所述关节子臂的偏差角度。
优选地,还包括:
标识点设置模块,用于在各个所述关节子臂的旋转关节处设置标识点,所述标识点与对应的舵机的旋转轴心点之间具有确定的位置关系,以使所述偏差角度计算模块以所述标识点为基准点,并根据所述标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
优选地,还包括:
舵机矫正步数计算模块,用于根据超出对应预设阈值的所述关节子臂的偏差角度,计算与超出对应预设阈值的所述关节子臂对应的舵机的矫正步数,以使所述位姿矫正模块控制超出对应预设阈值的所述关节子臂对应的舵机转动所述矫正步数。
一种机械臂初始位姿自动矫正设备,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现上述任意一种机械臂初始位姿自动矫正方法的步骤。
一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现上述任意一种机械臂初始位姿自动矫正方法的步骤。
本发明提供的机械臂初始位姿自动矫正方法,通过获取机械臂的图像,并通过对机械臂的图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,并将各个关节子臂的偏差角度与对应的预设阈值做比较,当任意一个关节子臂的偏差角度超出与之对应的预设阈值时,则通过控制与该关节子臂对应的舵机动作,来调整关节子臂的初始位置。
可以看出,上述过程可以实现自动化,达到自动矫正机械臂各个关节子臂的初始位姿的目的,使得机械臂各关节子臂的偏差角度均能满足对应的预设阈值要求。
因此,相比于现有技术通过人为判断机械臂的初始位姿是否存在偏差,并利用工具来矫正机械臂的位置来说,克服了主观因素的影响,使机械臂各个关节子臂的偏差角度计算的更准确,提高了机械臂初始位姿的矫正精度,确保机械臂复位的准确性,省时省力。
本发明提供的机械臂初始位姿自动矫正装置、设备及计算机可读存储介质,与上述机械臂初始位姿自动矫正方法相对应,均具有上述有益效果。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其它的附图。
图1为本发明具体实施例一提供的机械臂初始位姿自动矫正方法的流程图;
图2为本发明具体实施例二提供的机械臂初始位姿自动矫正方法的流程图;
图3为本发明具体实施例提供的机械臂初始位姿自动矫正装置的结构图;
图4为本发明具体实施例提供的机械臂初始位姿自动矫正设备的结构图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
本发明的核心是提供一种机械臂初始位姿自动矫正方法,以提高机械臂初始位姿矫正的精确性,确保机械臂复位的准确性。本发明的另一核心是提供一种机械臂初始位姿自动矫正装置、设备及存储介质,均具有上述有益效果。
请参考图1和图2,图1为本发明具体实施例一提供的机械臂初始位姿自动矫正方法的流程图;图2为本发明具体实施例二提供的机械臂初始位姿自动矫正方法的流程图。
本发明提供一种机械臂初始位姿自动矫正方法,包括步骤S1至步骤S5:
步骤S1:获取机械臂的图像。
需要说明的是,本发明对获取机械臂的图像的具体方式不做限定,例如,可以采用图像采集器来获取机械臂的主视图。优选地,图像采集器为相机。
步骤S2:对机械臂的图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,其中,机械臂包括至少一个关节子臂。
需要说明的是,本发明中的机械臂为关节式机械臂,包括至少一个关节子臂,本发明对关节子臂的具体数量不做限定;其中,关节子臂是指机械臂中每一个具有独立舵机且可在对应舵机的驱动下单独运动的臂,换句话说,机械臂是指由至少一个关节子臂依次相连形成的整体臂状结构。
另外,需要说明的是,这里对机械臂的图像进行处理的具体方式不做限定,本领域技术人员可以采用常规的图像处理方式,只要便于通过计算得到机械臂各个关节子臂的偏差角度即可。
例如,可以根据机械臂的图像生成灰度图,对灰度图进行反阈值二值化处理,然后,根据二值化图得到各个关节子臂对应的各个舵机的旋转轴心点的位置坐标以及机械臂末端的法兰中心点的位置坐标,以便根据各个关节子臂对应的各个舵机的旋转轴心点的位置坐标以及机械臂末端的法兰中心点的位置坐标,计算得到机械臂各个关节子臂的偏差角度。
步骤S3:判断各个关节子臂的偏差角度是否超出对应的预设阈值。
需要说明的是,这里的偏差角度是指各个关节子臂的实际初始位置与其理论初始位置之间的夹角。
可以理解的是,每个关节子臂的偏差角度均对应一个预设阈值,各个关节子臂的偏差角度对应的预设阈值可以相等,也可以不相等,本领域技术人员可以根据实际情况来设定。
步骤S4:若是,则控制超出对应预设阈值的关节子臂所对应的舵机动作,以调整关节子臂的初始位置,并在调整后返回步骤S1。
步骤S5:若否,则结束。
也就是说,在任意一个关节子臂的偏差角度超出其对应的预设阈值时,则通过控制该关节子臂对应的舵机动作,来调整该关节子臂的初始位置,以减小或消除该偏差角度。
可以理解的是,在调整该关节子臂的初始位置后,需要重复执行步骤S1至步骤S3,以判断调整后的关节子臂的偏差角度是否超出对应的预设阈值,若是,则继续执行步骤S4,如此循环,直至该关节子臂的偏差角度满足对应的预设阈值要求为止,也即,当各个关节子臂的偏差角度均未超出对应的预设阈值时,则结束。
由此可以看出,本发明提供的机械臂初始位姿自动矫正方法,通过获取机械臂的图像,并通过对机械臂的图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,并将各个关节子臂的偏差角度与对应的预设阈值做比较,当任意一个关节子臂的偏差角度超出与之对应的预设阈值时,则通过控制与该关节子臂对应的舵机动作,来调整关节子臂的初始位置。
可以看出,上述过程可以实现自动化,达到自动矫正机械臂各个关节子臂的初始位姿的目的,使得机械臂各关节子臂的偏差角度均能满足对应的预设阈值要求。
因此,相比于现有技术通过人为判断机械臂的初始位姿是否存在偏差,并利用工具来矫正机械臂的位置来说,克服了主观因素的影响,使机械臂各个关节子臂的偏差角度计算的更准确,提高了机械臂初始位姿的矫正精度,确保机械臂复位的准确性,而且省时省力。
考虑到获取机械臂各个关节子臂的偏差角度的具体实现方式,在上述实施例的基础之上,当关节子臂的数量为至少两个时,步骤S2:对机械臂的图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,包括以下两个子步骤,也即步骤S21和步骤S22:
步骤S21:根据机械臂的图像,得到各个关节子臂对应的各个舵机的旋转轴心点的位置坐标以及机械臂末端的法兰中心点的位置坐标。
可以理解的是,定义相邻两个关节子臂中的一者为前关节子臂,另一者为后关节子臂,并定义前关节子臂对应的舵机为第一舵机,后关节子臂对应的舵机为第二舵机,则前关节子臂与第一舵机的旋转轴相连,后关节子臂与第二舵机的旋转轴相连;又因为,本领域技术人员可以理解的是,第二舵机固定于前关节子臂远离第一舵机的一端。
也即,第一舵机和第二舵机相当于前关节子臂的两个端点,因此,第一舵机和第二舵机的旋转轴心点的位置坐标则决定了前关节子臂的初始位置。
以此类推,可以确定除末端关节子臂以外的各个关节子臂的初始位置。
另外,对于末端的关节子臂来说,其一端与对应的舵机的旋转轴相连,另一端固设有法兰,因此,根据末端关节子臂对应的舵机的旋转轴心点的位置坐标和法兰中心点的位置坐标,可以确定末端关节子臂的初始位置。
步骤S22:根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于机械臂末端的舵机的旋转轴心点的位置坐标与法兰中心点的位置坐标,计算位于机械臂末端的舵机的旋转轴心点与法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个关节子臂的偏差角度。
需要说明的是,通常情况下,定义各个关节子臂的理论初始位置为竖直状态,因此,此时可以优选以竖直线为水平线为基准,来确定各关节子臂的偏差角度。
由上述分析可知,根据相邻两个舵机的旋转轴心点的位置坐标,可以确定该两个舵机之间的关节子臂的位置,也即,相邻两个舵机的旋转轴心点之间的连线则代表了该两个舵机之间的关节子臂的实际初始位置,因此,相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角,即为该两个舵机之间的关节子臂的偏差角度。
同理,位于机械臂末端的舵机的旋转轴心点的位置坐标与法兰中心点的位置坐标,可以确定末端的关节子臂的位置,也即,位于机械臂末端的舵机的旋转轴心点与法兰中心点之间的连线则代表了末端的关节子臂的实际初始位置,因此,位于机械臂末端的舵机的旋转轴心点与法兰中心点之间的连线相对竖直方向或水平方向的夹角,即为末端的关节子臂的偏差角度。
由此可知,根据各个关节子臂对应的各个舵机的旋转轴心点的位置坐标以及机械臂末端的法兰中心点的位置坐标,可以计算得到各个关节子臂的偏差角度。
可以理解的是,通常情况下,舵机设于关节子臂的内部,因此,为了便于通过图像识别确定舵机的旋转轴心点的位置坐标,在上述实施例的基础之上,在步骤S1:获取机械臂的图像之前,还包括:
在各个关节子臂的旋转关节处设置标识点,标识点与对应的舵机的旋转轴心点之间具有确定的位置关系。
可以理解的是,相邻两个关节子臂的连接处称为旋转关节,关节子臂在对应舵机的驱动下可绕其对应的旋转关节转动。
显然,一旦标识点设置完成,则标识点在旋转关节上的位置即确定,而当机械臂的结构设计完成后,舵机相对旋转关节的位置是确定的,因此,标识点与对应的舵机的旋转轴心点之间具有确定的位置关系。
需要说明的是,标识点设置在旋转关节的外部,以便于图像采集器在获取机械臂的图像时能够很容易的识别该标识点,然后,根据标识点的位置坐标和标识点与对应的舵机的旋转轴心点之间的位置关系,则可确定舵机的旋转轴心点的位置坐标。
也即,在步骤S21:根据机械臂的图像,得到各个关节子臂对应的各个舵机的旋转轴心点的位置坐标的过程中,包括:
以标识点为基准点,并根据标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
在上述实施例的基础之上,在步骤S4:控制超出对应预设阈值的所述关节子臂所对应的舵机动作之前,还包括步骤S6:
步骤S6:根据超出对应预设阈值的关节子臂的偏差角度,计算与该关节子臂对应的舵机的矫正步数。
可以理解的是,关节子臂的偏差角度,也即该关节子臂对应的舵机应矫正的旋转角度,对应舵机的矫正步数,例如,舵机旋转一周360度需要走4096步,则偏差角度为1度时,则舵机对应的矫正步数为4096/360步(需要说明的是,舵机的矫正步数按四舍五入,取整数)。
在此基础上,步骤S4:控制超出对应预设阈值的所述关节子臂所对应的舵机动作,包括:
步骤S41:控制超出对应预设阈值的关节子臂所对应的舵机转动矫正步数。
也即,本实施例通过控制关节子臂对应的舵机转动矫正步数,来减小或消除关节子臂的偏差角度。
请参考图3,为本发明实施例提供的机械臂初始位姿自动矫正装置的结构图。
除了上述机械臂初始位姿自动矫正方法,本发明还提供一种实现上述实施例公开的机械臂初始位姿自动矫正方法的机械臂初始位姿自动矫正装置,该机械臂初始位姿自动矫正装置与上述方法实施例相对应,下文描述的机械臂初始位姿自动矫正装置与上文描述的机械臂初始位姿自动矫正方法可相互对应参照。
该机械臂初始位姿自动矫正装置包括:
图像采集模块11,用于获取机械臂的图像;
偏差角度计算模块12,用于对机械臂的图像进行图像处理,计算得到机械臂各个关节子臂的偏差角度,其中,机械臂包括至少一个关节子臂;
判断模块13,用于判断各个关节子臂的偏差角度是否超出对应的预设阈值;
位姿矫正模块14,用于当关节子臂的偏差角度超出对应的预设阈值时,则控制超出对应预设阈值的关节子臂所对应的舵机动作,以调整该关节子臂的初始位置。
可以理解的是,图像采集模块11与偏差角度计算模块12相连,偏差角度计算模块12与判断模块13相连,判断模块13与位姿矫正模块14相连,同时,位姿矫正模块14与图像采集模块11相连,以在执行位姿矫正模块14后,再次执行图像采集模块11,用于获取调整后的机械臂的图像,以得到调整后各个关节子臂的偏差角度,进而通过判断模块13判断调整后各个关节子臂的偏差角度是否超出对应的预设阈值,以确保最终将超出对应的预设阈值的关节子臂的偏差角度调整至满足对应的预设阈值要求。
显然,本发明实施例提供的机械臂初始位姿自动矫正装置,具有上述机械臂初始位姿自动矫正方法的有益效果。
在上述实施例的基础之上,偏差角度计算模块12包括:
位置坐标获取模块,用于根据机械臂的图像,得到各个关节子臂对应的各个舵机的旋转轴心点的位置坐标以及机械臂末端的法兰中心点的位置坐标;
计算模块,用于根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于机械臂末端的舵机的旋转轴心点的位置坐标与法兰中心点的位置坐标,计算位于机械臂末端的舵机的旋转轴心点与法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个关节子臂的偏差角度。
在上述实施例的基础之上,还包括:
标识点设置模块,用于在各个关节子臂的旋转关节处设置标识点,标识点与对应的舵机的旋转轴心点之间具有确定的位置关系,以使位置坐标获取模块以标识点为基准点,并根据标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
需要说明的是,优选地,标识点设置模块包括自动在各个关节子臂的旋转关节处打标识的机构,以实现对各个关节子臂的旋转关节的预设位置进行自动打标识。
在上述实施例的基础之上,还包括:
舵机矫正步数计算模块,用于根据超出对应预设阈值的关节子臂的偏差角度,计算与该关节子臂对应的舵机的矫正步数。
舵机矫正步数计算模块与位姿矫正模块14相连,以使位姿矫正模块14控制超出对应预设阈值的关节子臂所对应的舵机转动所需的矫正步数,从而减小或消除超出对应预设阈值的关节子臂的偏差角度。
请参见图4,图4为本发明具体实施例所提供的机械臂初始位姿自动矫正设备的结构图,该机械臂初始位姿自动矫正设备相应于上述机械臂初始位姿自动矫正方法的实施例,可以包括:
存储器21,用于存储计算机程序。
处理器22,用于执行上述存储器21存储的计算机程序时实现如上述任意一个实施例公开的机械臂初始位姿自动矫正方法的步骤。
本发明实施例提供的机械臂初始位姿自动矫正设备,具有上述机械臂初始位姿自动矫正方法的有益效果。
对于本发明提供的机械臂初始位姿自动矫正设备的介绍请参照上述方法实施例,本发明在此不做赘述。
相应于上面的方法实施例,本发明还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现如上述任意一个实施例公开的机械臂初始位姿自动矫正方法的步骤。
本发明实施例提供的计算机可读存储介质,具有上述机械臂初始位姿自动矫正方法的有益效果。
该计算机可读存储介质可以包括:U盘、移动硬盘、只读存储器(Read-OnlyMemory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
对于本发明提供的计算机可读存储介质的介绍请参照上述方法实施例,本发明在此不做赘述。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其它实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
以上对本发明所提供的机械臂初始位姿自动矫正方法、装置、设备及存储介质进行了详细介绍。本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干改进和修饰,这些改进和修饰也落入本发明权利要求的保护范围内。
Claims (10)
1.一种机械臂初始位姿自动矫正方法,其特征在于,包括:
S1:获取机械臂的图像;
S2:对所述图像进行图像处理,计算得到所述机械臂各个关节子臂的偏差角度,其中,所述机械臂包括至少一个所述关节子臂;
S3:判断各个所述关节子臂的偏差角度是否超出对应的预设阈值;
S4:若是,则控制超出对应预设阈值的所述关节子臂所对应的舵机动作,以调整所述关节子臂的初始位置,并在调整后返回步骤S1;
S5:若否,则结束。
2.根据权利要求1所述的机械臂初始位姿自动矫正方法,其特征在于,所述关节子臂的数量为至少两个,得到所述机械臂各个关节子臂的偏差角度的过程,包括:
根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标以及所述机械臂末端的法兰中心点的位置坐标;
根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于所述机械臂末端的舵机的旋转轴心点的位置坐标与所述法兰中心点的位置坐标,计算位于所述机械臂末端的舵机的旋转轴心点与所述法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个所述关节子臂的偏差角度。
3.根据权利要求2所述的机械臂初始位姿自动矫正方法,其特征在于,在获取机械臂的图像之前,还包括:
在各个所述关节子臂的旋转关节处设置标识点,所述标识点与对应的舵机的旋转轴心点之间具有确定的位置关系;
根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标的过程中,包括:
以所述标识点为基准点,并根据所述标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
4.根据权利要求1-3任一项所述的机械臂初始位姿自动矫正方法,其特征在于,在控制超出对应预设阈值的所述关节子臂所对应的舵机动作之前,还包括:
根据超出对应预设阈值的所述关节子臂的偏差角度,计算与所述关节子臂对应的舵机的矫正步数;
其中,控制超出对应预设阈值的所述关节子臂所对应的舵机动作,包括:
控制超出对应预设阈值的所述关节子臂对应的舵机转动所述矫正步数。
5.一种机械臂初始位姿自动矫正装置,其特征在于,包括:
图像采集模块,用于获取机械臂的图像;
偏差角度计算模块,用于对所述图像进行图像处理,计算得到所述机械臂各个关节子臂的偏差角度,其中,所述机械臂包括至少一个所述关节子臂;
判断模块,用于判断各个所述关节子臂的偏差角度是否超出对应的预设阈值;
位姿矫正模块,用于当所述关节子臂的偏差角度超出对应的预设阈值时,则控制超出对应预设阈值的所述关节子臂所对应的舵机动作,以调整所述关节子臂的初始位置。
6.根据权利要求5所述的机械臂初始位姿自动矫正装置,其特征在于,所述偏差角度计算模块包括:
位置坐标获取模块,用于根据所述图像,得到各个所述关节子臂对应的各个舵机的旋转轴心点的位置坐标以及所述机械臂末端的法兰中心点的位置坐标;
计算模块,用于根据相邻两个舵机的旋转轴心点的位置坐标,计算相邻两个舵机的旋转轴心点之间的连线相对竖直方向或水平方向的夹角;并根据位于所述机械臂末端的舵机的旋转轴心点的位置坐标与所述法兰中心点的位置坐标,计算位于所述机械臂末端的舵机的旋转轴心点与所述法兰中心点之间的连线相对竖直方向或水平方向的夹角,得到各个所述关节子臂的偏差角度。
7.根据权利要求6所述的机械臂初始位姿自动矫正装置,其特征在于,还包括:
标识点设置模块,用于在各个所述关节子臂的旋转关节处设置标识点,所述标识点与对应的舵机的旋转轴心点之间具有确定的位置关系,以使所述偏差角度计算模块以所述标识点为基准点,并根据所述标识点与对应的舵机的旋转轴心点之间的位置关系,计算得到各个舵机的旋转轴心点的位置坐标。
8.根据权利要求5-7任一项所述的机械臂初始位姿自动矫正装置,其特征在于,还包括:
舵机矫正步数计算模块,用于根据超出对应预设阈值的所述关节子臂的偏差角度,计算与超出对应预设阈值的所述关节子臂对应的舵机的矫正步数,以使所述位姿矫正模块控制超出对应预设阈值的所述关节子臂对应的舵机转动所述矫正步数。
9.一种机械臂初始位姿自动矫正设备,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现如权利要求1至4任一项所述的机械臂初始位姿自动矫正方法的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至4任一项所述的机械臂初始位姿自动矫正方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011504661.XA CN112706164B (zh) | 2020-12-18 | 2020-12-18 | 机械臂初始位姿自动矫正方法、装置、设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011504661.XA CN112706164B (zh) | 2020-12-18 | 2020-12-18 | 机械臂初始位姿自动矫正方法、装置、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112706164A true CN112706164A (zh) | 2021-04-27 |
CN112706164B CN112706164B (zh) | 2022-05-24 |
Family
ID=75544477
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011504661.XA Active CN112706164B (zh) | 2020-12-18 | 2020-12-18 | 机械臂初始位姿自动矫正方法、装置、设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112706164B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113499094A (zh) * | 2021-07-08 | 2021-10-15 | 中山大学 | 一种依靠视觉及力反馈引导的心脏彩超检查装置和方法 |
CN114147725A (zh) * | 2021-12-21 | 2022-03-08 | 乐聚(深圳)机器人技术有限公司 | 机器人的零点调整方法、装置、设备及存储介质 |
CN114474062A (zh) * | 2022-02-21 | 2022-05-13 | 乐聚(深圳)机器人技术有限公司 | 机器人控制方法、装置、机器人及存储介质 |
CN116038707A (zh) * | 2023-01-30 | 2023-05-02 | 深圳技术大学 | 一种基于数据驱动的智能故障自动诊断系统 |
CN117773954A (zh) * | 2024-02-27 | 2024-03-29 | 深圳威洛博机器人有限公司 | 一种机器人关节模组运动控制系统及方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101524842A (zh) * | 2009-01-09 | 2009-09-09 | 成都广泰实业有限公司 | 工业机器人校准方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂系统及其实时校准方法 |
CN108453727A (zh) * | 2018-01-11 | 2018-08-28 | 中国人民解放军63920部队 | 基于椭圆特征的机械臂末端位姿误差校正方法及系统 |
JP2019014031A (ja) * | 2017-07-11 | 2019-01-31 | セイコーエプソン株式会社 | ロボットの制御装置、ロボット、ロボットシステム、並びに、ロボット用カメラの校正方法 |
CN109859275A (zh) * | 2019-01-17 | 2019-06-07 | 南京邮电大学 | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 |
CN109927034A (zh) * | 2019-04-08 | 2019-06-25 | 广州市威控机器人有限公司 | 校准装置及校准方法 |
-
2020
- 2020-12-18 CN CN202011504661.XA patent/CN112706164B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101524842A (zh) * | 2009-01-09 | 2009-09-09 | 成都广泰实业有限公司 | 工业机器人校准方法 |
CN102922521A (zh) * | 2012-08-07 | 2013-02-13 | 中国科学技术大学 | 一种基于立体视觉伺服的机械臂系统及其实时校准方法 |
JP2019014031A (ja) * | 2017-07-11 | 2019-01-31 | セイコーエプソン株式会社 | ロボットの制御装置、ロボット、ロボットシステム、並びに、ロボット用カメラの校正方法 |
CN108453727A (zh) * | 2018-01-11 | 2018-08-28 | 中国人民解放军63920部队 | 基于椭圆特征的机械臂末端位姿误差校正方法及系统 |
CN109859275A (zh) * | 2019-01-17 | 2019-06-07 | 南京邮电大学 | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 |
CN109927034A (zh) * | 2019-04-08 | 2019-06-25 | 广州市威控机器人有限公司 | 校准装置及校准方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113499094A (zh) * | 2021-07-08 | 2021-10-15 | 中山大学 | 一种依靠视觉及力反馈引导的心脏彩超检查装置和方法 |
CN114147725A (zh) * | 2021-12-21 | 2022-03-08 | 乐聚(深圳)机器人技术有限公司 | 机器人的零点调整方法、装置、设备及存储介质 |
CN114147725B (zh) * | 2021-12-21 | 2024-04-02 | 乐聚(深圳)机器人技术有限公司 | 机器人的零点调整方法、装置、设备及存储介质 |
CN114474062A (zh) * | 2022-02-21 | 2022-05-13 | 乐聚(深圳)机器人技术有限公司 | 机器人控制方法、装置、机器人及存储介质 |
CN116038707A (zh) * | 2023-01-30 | 2023-05-02 | 深圳技术大学 | 一种基于数据驱动的智能故障自动诊断系统 |
CN116038707B (zh) * | 2023-01-30 | 2023-08-04 | 深圳技术大学 | 一种基于数据驱动的智能故障自动诊断系统 |
CN117773954A (zh) * | 2024-02-27 | 2024-03-29 | 深圳威洛博机器人有限公司 | 一种机器人关节模组运动控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112706164B (zh) | 2022-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112706164B (zh) | 机械臂初始位姿自动矫正方法、装置、设备及存储介质 | |
CN107767423B (zh) | 一种基于双目视觉的机械臂目标定位抓取方法 | |
CN109129445B (zh) | 机械臂的手眼标定方法、标定板、装置、设备和存储介质 | |
EP3157715B1 (en) | Method for calibrating a robot and a robot system | |
CN107908195B (zh) | 目标追踪方法、装置、追踪器及计算机可读存储介质 | |
US11644841B2 (en) | Robot climbing control method and robot | |
CN108927801B (zh) | 一种机械臂末端姿态调整方法及装置 | |
CN111405842B (zh) | 一种三引脚电子元器件的引脚自适应定位插装方法及系统 | |
CN110378182B (zh) | 图像解析装置、图像解析方法及记录介质 | |
CN113894481A (zh) | 复杂空间曲线焊缝的焊接位姿调整方法及装置 | |
CN111993422B (zh) | 基于无标定视觉的机器人轴孔对准控制方法 | |
CN115205286B (zh) | 爬塔机器人机械臂螺栓识别与定位方法、存储介质、终端 | |
CN111684382A (zh) | 可移动平台状态估计方法、系统、可移动平台及存储介质 | |
CN113538358A (zh) | 机器人行走纠偏方法、装置、智能机器人和存储介质 | |
CN109671059B (zh) | 一种基于OpenCV的电池盒图像处理方法及系统 | |
WO2020037466A1 (zh) | 一种图像匹配方法及视觉系统 | |
CN112215214A (zh) | 调整智能车载终端的摄像头偏移的方法及系统 | |
CN113118604B (zh) | 基于机器人手眼视觉反馈的高精度凸焊误差补偿系统 | |
CN113326819B (zh) | 机器手素描绘画方法、装置及机器人工作台 | |
CN111383283A (zh) | 机器人的工具坐标系的标定方法及系统 | |
CN111210392A (zh) | 一种基于数字图像处理的轮毂气门孔定位方法 | |
CN113442144A (zh) | 欠约束下的最优位姿确定方法、装置、存储介质及机械臂 | |
US20230032421A1 (en) | Robot system | |
CN112790786A (zh) | 点云数据配准方法、装置、超声设备及存储介质 | |
CN113442145B (zh) | 欠约束下的最优位姿确定方法、装置、存储介质及机械臂 |
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 |