CN113715010A - 一种蛇形机械臂视觉反馈与自主回零的方法 - Google Patents
一种蛇形机械臂视觉反馈与自主回零的方法 Download PDFInfo
- Publication number
- CN113715010A CN113715010A CN202010431920.4A CN202010431920A CN113715010A CN 113715010 A CN113715010 A CN 113715010A CN 202010431920 A CN202010431920 A CN 202010431920A CN 113715010 A CN113715010 A CN 113715010A
- Authority
- CN
- China
- Prior art keywords
- joint
- coordinate system
- mechanical arm
- aruco
- 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.)
- Pending
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/06—Programme-controlled manipulators characterised by multi-articulated arms
- B25J9/065—Snake robots
-
- 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
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Image Analysis (AREA)
Abstract
本发明公开了一种蛇形机械臂视觉反馈与自主回零的方法。步骤1:通过ArUco辨识方法测量关节角,利用相机外参数与关节角之间存在的关系,利用ArUco关节角辨识方法测量蛇形机械臂每一个关节的实时关节角;步骤2:通过ArUco辨识方法测量关节角后,测得的实时关节用于蛇形机械臂自主回零。本发明解决传统蛇形机械臂任意位置回零困难的问题,进而提出基于ArUco标识的蛇形机械臂关节角辨识方法,能够测量机械臂关节角,从而用于蛇形臂的自主回零过程。
Description
技术领域
本发明属于蛇形机械臂的技术领域;具体涉及一种蛇形机械臂视觉反馈与自主回零的方法。
背景技术
蛇形机械臂是仿生学机器人的典型代表,具有柔性以及灵活度高的特点,相比于传统刚性结构机械臂有更强的适应能力,目前广泛应用于医疗手术、航空发动机探伤检测等诸多领域。蛇形机械臂结构可以具备小型化、轻型化等难以替代的优势,因此在未来智能仿生机器人领域中有很大潜力。
蛇形机械臂是一种具有广泛应用前景的连续型超冗余机械臂,在面对复杂、恶劣环境工作时,要求机械臂具备对环境感知能力。
传统视觉标定常用张正友的平面棋盘格标定方法,棋盘是一块由黑白方块组成的网状标定板,棋盘格作为相机标定的标定物,此种标定方法是一种被大众广泛应用的相机参数标定方法。该种标定方法简单、易操作,但是不包含编码信息,不利于对蛇形机器臂关节编号。
发明内容
本发明解决传统蛇形机械臂任意位置回零困难的问题,进而提出基于ArUco标识的蛇形机械臂关节角辨识方法,能够测量机械臂关节角,从而用于蛇形臂的自主回零过程。
本发明通过以下技术方案实现:
一种蛇形机械臂视觉反馈与自主回零的方法,所述方法包括以下步骤:
步骤1:通过ArUco辨识方法测量关节角,利用相机外参数与关节角之间存在的关系,利用ArUco关节角辨识方法测量蛇形机械臂每一个关节的实时关节角;所述相机外参数为矩阵T,T=[R,t],其中R为3×3的正交单位矩阵t为三维平移向量,矢量获得各个ArUco标识码坐标系相对于相机坐标系的变换关系,在通过解算机械臂关节的ID号,就能确定ArUco标识码与关节号之间对应关系;
步骤2:通过ArUco辨识方法测量关节角后,测得的实时关节用于蛇形机械臂自主回零,由全局单目相机测得实时各个关节的关节角度,与角度期望值做差后作为角度误差输入进PD控制器,得到关节角速度,经雅克比矩阵得到绳索速度在通过积分器得到绳索变化量,进而构成自主回零闭环控制。
其中,T4为相机坐标系至基座坐标系的姿态变换矩阵,
T4=T2T1 TT3 (2)
Ric为第i个ArUco标识码相对于相机坐标系的旋转矩阵,是单目相机量测值。
其中,Ri-1,0为关节坐标系相对基座坐标系的旋转矩阵,绕x,y轴旋转的关节角αi,βi可以由下列方程求出,
niy=roty(βi)rotx(αi)[0 0 1]T (5)
其中rotx(α)为绕x轴旋转α角度的转转矩阵,roty(b)为绕y轴旋转β角度的旋转矩阵,Ri-1,0可以由如下公式求得,
Ri,0=Ri,i-1Ri-1,i-2…R1,0R0,0 (6)
最后由式(3)和式(5)联立即可求得,绕x轴旋转的关节角α和绕y轴旋转的关节角β,α和β即为基于ArUco辨识方法测量的关节角。
进一步的,所述步骤2具体为,首先求得绳索长度与关节速度的雅克比矩阵设为Jt,可通过绳索拉力与等效力矩之间的映射关系求得,
其中,z0,z1,…z2i-1为D-H坐标系的Z轴在惯性空间中的单位向量,p0,p1,...p2i为D-H坐标系的原点在惯性空间中的矢量坐标。
进一步的,所述公式(8)变换成,
其中,驱动力在椎段i的体坐标系原点处产生的力旋量为
干扰力在椎段i的体坐标系原点处产生的力旋量为
由于所有约束均为定常约束,因此绳长变化速率与角速率的关系为:
进一步的,所述绳长变化速率与角速率求出后,根据搭载在基座上的单目全局相机辨识机械臂关节上的ArUco码,通过ArUco辨识方法测量关节角原理得到机械臂各个关节相对于零位的关节角度;实时测量关节角与零位标定角度做差得到关节角度偏差,该偏差经过PD控制器之后,可得到关节角速度期望;因为蛇形机械臂各个关节没有安装驱动电机,最后驱动方式需转化为绳索拉力进而拉动各个关节运动,因此需要利用到雅克比矩阵把得到的关节角速度转化为绳索速率的变化量,在通过积分器对速率求积分得到绳索绳长的变化;
最后根据绳长速度变化驱动样机蛇形臂各个关节运动,基座单目相机实时测量机械臂关节角度,最终使各个关节角度回到零位位置,达到自主回零效果。
本发明的有益效果是:
1.本发明基于ArUco辨识方法作为蛇形机械臂的关节角标定,可方便快捷地为蛇形机械臂每一关节提供唯一识别号机械臂关节ID,方便于后续关节角计算。
2.本发明使用闭环反馈可以实现蛇形臂运动过程中实时位置停下后自主回零,有利于减少机械臂上的电子测量元器件安装,适应更加复杂、恶劣环境。
附图说明
图1本发明蛇形机械臂整机结构图。
图2本发明相机配置示意图。
图3本发明ArUco粘贴位置示意图。
图4本发明提取ArUco码示意图。
图5本发明回零方案流程图。
图6本发明ArUco标识码示意图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种蛇形机械臂视觉反馈与自主回零的方法,所述方法包括以下步骤:
步骤1:通过ArUco辨识方法测量关节角,利用相机外参数与关节角之间存在的关系,利用ArUco关节角辨识方法测量蛇形机械臂每一个关节的实时关节角;所述相机外参数为矩阵T,T=[R,t],其中R为3×3的正交单位矩阵(也叫旋转矩阵)t为三维平移向量,矢量获得各个ArUco标识码坐标系相对于相机坐标系的变换关系,在通过解算机械臂关节的ID号,就能确定ArUco标识码与关节号之间对应关系;
步骤2:通过ArUco辨识方法测量关节角后,测得的实时关节用于蛇形机械臂自主回零,如图5所示,由全局单目相机测得实时各个关节的关节角度,与角度期望值做差后作为角度误差输入进PD控制器,得到关节角速度,经雅克比矩阵得到绳索速度在通过积分器得到绳索变化量,进而构成自主回零闭环控制。蛇形机械臂工作过程中受环境影响,没有关节角测量电子元件,因此采用视觉标定的自主回零方法。
其中,T4为相机坐标系至基座坐标系的姿态变换矩阵,
T4=T2T1 TT3 (2)
Ric为第i个ArUco标识码相对于相机坐标系的旋转矩阵,是单目相机量测值。
其中,Ri-1,0为关节坐标系相对基座坐标系的旋转矩阵,绕x,y轴旋转的关节角αi,βi可以由下列方程求出,
niy=roty(βi)rotx(αi)[0 0 1]T (5)
其中rotx(α)为绕x轴旋转α角度的转转矩阵,roty(b)为绕y轴旋转β角度的旋转矩阵,Ri-1,0可以由如下公式求得,
Ri,0=Ri,i-1Ri-1,i-2…R1,0R0,0 (6)
最后由式(3)和式(5)联立即可求得,绕x轴旋转的关节角α和绕y轴旋转的关节角β,α和β即为基于ArUco辨识方法测量的关节角。
进一步的,所述步骤2具体为,首先求得绳索长度与关节速度的雅克比矩阵设为Jt,可通过绳索拉力与等效力矩之间的映射关系求得,
其中,z0,z1,…z2i-1为D-H坐标系的Z轴在惯性空间中的单位向量,p0,p1,…p2i为D-H坐标系的原点在惯性空间中的矢量坐标。
进一步的,所述公式(8)变换成,
其中,驱动力在椎段i的体坐标系原点处产生的力旋量为
干扰力在椎段i的体坐标系原点处产生的力旋量为
由于所有约束均为定常约束,因此绳长变化速率与角速率的关系为:
进一步的,对于规划绳长速度将用于图5中自主回零方案。对于本套蛇形臂系统来讲,蛇形臂各个关节没有安装电子元器件,比如编码器,因此对于关节角度测量依靠视觉测量得到的关节角α和β;当蛇形机械臂运动到任意位置后,绳长变化速率与角速率求出后,根据搭载在基座上的单目全局相机辨识机械臂关节上的ArUco码,通过ArUco辨识方法测量关节角原理得到机械臂各个关节相对于零位的关节角度;具体回零方案如图5所示,实时测量关节角与零位标定角度做差得到关节角度偏差,该偏差经过PD控制器之后,可得到关节角速度期望;因为蛇形机械臂各个关节没有安装驱动电机,最后驱动方式需转化为绳索拉力进而拉动各个关节运动,因此需要利用到雅克比矩阵把得到的关节角速度转化为绳索速率的变化量,在通过积分器对速率求积分得到绳索绳长的变化;
最后根据绳长速度变化驱动样机蛇形臂各个关节运动,基座单目相机实时测量机械臂关节角度,进而形成图5闭环方案,最终使各个关节角度回到零位位置,达到自主回零效果。
Claims (6)
1.一种蛇形机械臂视觉反馈与自主回零的方法,其特征在于,所述方法包括以下步骤:
步骤1:通过ArUco辨识方法测量关节角,利用相机外参数与关节角之间存在的关系,利用ArUco关节角辨识方法测量蛇形机械臂每一个关节的实时关节角;所述相机外参数为矩阵T,T=[R,t],其中R为3×3的正交单位矩阵t为三维平移向量,矢量获得各个ArUco标识码坐标系相对于相机坐标系的变换关系,在通过解算机械臂关节的ID号,就能确定ArUco标识码与关节号之间对应关系;
步骤2:通过ArUco辨识方法测量关节角后,测得的实时关节用于蛇形机械臂自主回零,由全局单目相机测得实时各个关节的关节角度,与角度期望值做差后作为角度误差输入进PD控制器,得到关节角速度,经雅克比矩阵得到绳索速度在通过积分器得到绳索变化量,进而构成自主回零闭环控制。
3.根据权利要求1所述一种蛇形机械臂视觉反馈与自主回零的方法,其特征在于,所述步骤1中机械臂关节ID号的计算,根据ArUco标识码坐标系的OiY轴与机械臂关节的Z轴向平行解算关节角,OiY轴在上一个关节的关节坐标系坐标系下的坐标分量niy为,
其中,Ri-1,0为关节坐标系相对基座坐标系的旋转矩阵,绕x,y轴旋转的关节角αi,βi可以由下列方程求出,
niy=roty(βi)rotx(αi)[0 0 1]T (5)
其中rotx(α)为绕x轴旋转α角度的转转矩阵,roty(β)为绕y轴旋转β角度的旋转矩阵,Ri-1,0可以由如下公式求得,
Ri,0=Ri,i-1Ri-1,i-2…R1,0R0,0 (6)
最后由式(3)和式(5)联立即可求得,绕x轴旋转的关节角α和绕y轴旋转的关节角β,α和β即为基于ArUco辨识方法测量的关节角。
6.根据权利要求5所述一种蛇形机械臂视觉反馈与自主回零的方法,其特征在于,所述绳长变化速率与角速率求出后,根据搭载在基座上的单目全局相机辨识机械臂关节上的ArUco码,通过ArUco辨识方法测量关节角原理得到机械臂各个关节相对于零位的关节角度;实时测量关节角与零位标定角度做差得到关节角度偏差,该偏差经过PD控制器之后,可得到关节角速度期望;因为蛇形机械臂各个关节没有安装驱动电机,最后驱动方式需转化为绳索拉力进而拉动各个关节运动,因此需要利用到雅克比矩阵把得到的关节角速度转化为绳索速率的变化量,在通过积分器对速率求积分得到绳索绳长的变化;
最后根据绳长速度变化驱动样机蛇形臂各个关节运动,基座单目相机实时测量机械臂关节角度,最终使各个关节角度回到零位位置,达到自主回零效果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010431920.4A CN113715010A (zh) | 2020-05-20 | 2020-05-20 | 一种蛇形机械臂视觉反馈与自主回零的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010431920.4A CN113715010A (zh) | 2020-05-20 | 2020-05-20 | 一种蛇形机械臂视觉反馈与自主回零的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113715010A true CN113715010A (zh) | 2021-11-30 |
Family
ID=78671275
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010431920.4A Pending CN113715010A (zh) | 2020-05-20 | 2020-05-20 | 一种蛇形机械臂视觉反馈与自主回零的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113715010A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115026814A (zh) * | 2022-06-01 | 2022-09-09 | 中科苏州智能计算技术研究院 | 用于机械臂运动空间重建的相机自动标定方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107263477A (zh) * | 2017-07-07 | 2017-10-20 | 浙江大学 | 一种绳驱动串联关节型蛇形机械臂控制方法 |
CN108297079A (zh) * | 2018-03-30 | 2018-07-20 | 中山市博奥控制技术有限公司 | 一种蛇形机械臂及其姿态变化的获取方法 |
CN109227538A (zh) * | 2018-07-13 | 2019-01-18 | 哈尔滨工业大学(深圳) | 一种基于视觉的柔性机械臂的定位控制方法及系统 |
CN110000787A (zh) * | 2019-04-12 | 2019-07-12 | 清华大学深圳研究生院 | 一种超冗余机械臂的控制方法 |
US20200139557A1 (en) * | 2017-07-13 | 2020-05-07 | Alina Grädener | Arrangement for an articulated arm robot and method for determining the positioning of a mount for an end effector of an articulated arm robot |
-
2020
- 2020-05-20 CN CN202010431920.4A patent/CN113715010A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107263477A (zh) * | 2017-07-07 | 2017-10-20 | 浙江大学 | 一种绳驱动串联关节型蛇形机械臂控制方法 |
US20200139557A1 (en) * | 2017-07-13 | 2020-05-07 | Alina Grädener | Arrangement for an articulated arm robot and method for determining the positioning of a mount for an end effector of an articulated arm robot |
CN108297079A (zh) * | 2018-03-30 | 2018-07-20 | 中山市博奥控制技术有限公司 | 一种蛇形机械臂及其姿态变化的获取方法 |
CN109227538A (zh) * | 2018-07-13 | 2019-01-18 | 哈尔滨工业大学(深圳) | 一种基于视觉的柔性机械臂的定位控制方法及系统 |
CN110000787A (zh) * | 2019-04-12 | 2019-07-12 | 清华大学深圳研究生院 | 一种超冗余机械臂的控制方法 |
Non-Patent Citations (1)
Title |
---|
张泽铭: "基于视觉的绳驱蛇形机械臂运动控制研究", 《中国优秀博硕士学位论文全文数据库(硕士)》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115026814A (zh) * | 2022-06-01 | 2022-09-09 | 中科苏州智能计算技术研究院 | 用于机械臂运动空间重建的相机自动标定方法 |
CN115026814B (zh) * | 2022-06-01 | 2024-04-12 | 中科苏州智能计算技术研究院 | 用于机械臂运动空间重建的相机自动标定方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN107042528B (zh) | 一种工业机器人的运动学标定系统及方法 | |
Hyatt et al. | Configuration estimation for accurate position control of large-scale soft robots | |
Jeon et al. | A paired visual servoing system for 6-DOF displacement measurement of structures | |
CN110948522B (zh) | 一种基于拉线旋转传感器的工业机器人空间位姿测量机构及测量方法 | |
Miller et al. | Integration of vision, force and tactile sensing for grasping | |
CN107457783B (zh) | 基于pd控制器的六自由度机械臂自适应智能检测方法 | |
CN109238199B (zh) | 一种机器人旋转轴运动学参数标定方法 | |
CN107553493A (zh) | 一种基于拉绳位移传感器的机器人运动学参数标定方法 | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN106777656A (zh) | 一种基于pmpsd的工业机器人绝对精度校准方法 | |
CN107414827B (zh) | 基于线性反馈控制器的六自由度机械臂自适应检测方法 | |
CN114216456A (zh) | 一种基于imu与机器人本体参数融合的姿态测量方法 | |
Majarena et al. | Modelling and calibration of parallel mechanisms using linear optical sensors and a coordinate measuring machine | |
CN113319855B (zh) | 一种多关节诊疗机器人柔顺力控制模式下的重力补偿方法 | |
CN113715010A (zh) | 一种蛇形机械臂视觉反馈与自主回零的方法 | |
Traslosheros et al. | One camera in hand for kinematic calibration of a parallel robot | |
Bellakehal et al. | Force/position control of parallel robots using exteroceptive pose measurements | |
CN117283528A (zh) | 一种并联机器人运动学模型在线学习方法 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
Abtahi et al. | Calibration of parallel kinematic machine tools using mobility constraint on the tool center point | |
Prenninger | Contactless position and orientation measurement of robot end-effectors | |
Kong et al. | An experimental comparison for the accuracy improvement of a 6-PSS parallel manipulator by choosing different sets of measurement data | |
D'Amore et al. | Imu-based manipulator kinematic identification | |
CN112057083A (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 |