3D位姿估计结合阻抗控制的沉孔装配

陈平; 雷学军; 李灿; 胡义亮; 陈爽

doi:10.37188/OPE.20223022.2889

您当前的位置：

首页 >

文章列表页 >

3D位姿估计结合阻抗控制的沉孔装配

微纳技术与精密机械 | 更新时间：2026-09-12

- 3D位姿估计结合阻抗控制的沉孔装配
- Assembly of countersunk-hole parts based on 3D pose estimation and impedance control
- 光学精密工程 2022年30卷第22期页码：2889-2900
- 作者机构：
  
  重庆大学机械与运载工程学院，重庆 400044
- 作者简介：
  
  陈平（1975-），男，湖北荆州人，副教授，2007年于重庆大学获得博士学位，主要从事机器视觉，机电一体化等方面的研究。E-mail： pingchen@cqu.edu.cn
  雷学军（1997-），男，湖北十堰人，硕士研究生，2020年于武汉科技大学获得学士学位，主要从3D视觉与三维重建方面的研究。E-mail： 1473363911@qq.com
- 基金信息：
  
  国家重点研发计划(2019YFB1703600)
- DOI：10.37188/OPE.20223022.2889
  中图分类号： TP394.1;TH691.9
- 收稿：2022-07-20，
  
  修回：2022-08-28，
  
  纸质出版：2022-11-25
- 稿件说明：
移动端阅览
陈平,雷学军,李灿等.3D位姿估计结合阻抗控制的沉孔装配[J].光学精密工程,2022,30(22):2889-2900.

CHEN Ping,LEI Xuejun,LI Can,et al.Assembly of countersunk-hole parts based on 3D pose estimation and impedance control[J].Optics and Precision Engineering,2022,30(22):2889-2900.
陈平,雷学军,李灿等.3D位姿估计结合阻抗控制的沉孔装配[J].光学精密工程,2022,30(22):2889-2900. DOI： 10.37188/OPE.20223022.2889.

CHEN Ping,LEI Xuejun,LI Can,et al.Assembly of countersunk-hole parts based on 3D pose estimation and impedance control[J].Optics and Precision Engineering,2022,30(22):2889-2900. DOI： 10.37188/OPE.20223022.2889.

摘要

面向长圆轴零件与沉孔零件的自动装配需求，针对装配中任意位置和姿态的零件柔顺装配的问题，研究了3D视觉和力觉结合的柔顺装配策略。在3D视觉定位方法中，提出了一种沉孔零件位姿估计的算法：首先使用超体素分割和约束平面分割（Constrained Planar Cuts， CPC）聚类完成点云数据的预处理，再利用基于权重的随机采样一致性（Weight-based Random Sample Consensus， WRANSAC）平面拟合完成平面定位，通过沉孔的轮廓提取与圆拟合估计装配位置。在力觉方法中，采用阻抗控制实现零件的柔顺装配。实验结果表明：本文提出的WRANSAC平面拟合算法的平均距离误差

https://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=118010757&type=

https://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=118010726&type=

4.06400013

2.37066650

可以达到0.09 mm，角度误差

https://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=118010779&type=

https://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=118010765&type=

3.72533321

2.37066650

可以达到1.8°；3D空间中沉孔位姿的角度误差为1.0°，可实现配合间隙为0.5 mm的零件的装配。装配策略满足沉孔装配对精度及柔顺的要求。

Abstract

For robotic assembly long cylindrical shaft and countersunk-hole parts， this paper investigates the assembly strategies of combining 3D vision， and force perception for compliantly assembling parts in arbitrary positions and poses during assembly. An algorithm is proposed based 3D vision for pose estimation of countersunk-hole parts： firstly， use supervoxel segmentation

， Constrained Planar Cuts （CPC）and clustering to complete the preprocessing of point cloud， and then use Weight-based Random Sample Consensus （WRANSAC） plane fitting to acquire plane pose， finally， estimate the assembly position by profile extraction and circle fitting of countersunk-hole. In addition， we implement the compliant assembly of the parts using impedance control. The experimental results indicate that the average distance error

∆d

of WRANSAC plane fitting algorithm can be as high as 0.09 mm and the angular error

∆θ

can be as high as 1.8°. Moreover， the angular error of the countersunk-hole position in 3D space is 1.0°， which can realize the assembly of parts with a mating clearance of 0.5 mm. The assembly strategy meets the requirements of high precision and compliance of countersunk-hole assembly.

关键词

Keywords

references

胡瑞钦，隆昌宇，张立建 . 视觉与力觉结合的卫星部件机器人装配［J］. 光学精密工程， 2018 ， 26 （ 10 ）： 2504 - 2515 . doi: 10.3788/ope.20182610.2504 http://dx.doi.org/10.3788/ope.20182610.2504

HU R Q ， LONG CH Y ， ZHANG L J . Robotic assembly technology for satellite components based on visual and force information ［J］. Opt. Precision Eng. ， 2018 ， 26 （ 10 ）： 2504 - 2515 . （in Chinese） . doi: 10.3788/ope.20182610.2504 http://dx.doi.org/10.3788/ope.20182610.2504

CHEN Z ， XIE S Y ， ZHANG X M . Position/force visual-sensing-based robotic sheet-like peg-in-hole assembly ［J］. IEEE Transactions on Instrumentation and Measurement ， 2022 ， 71 ： 1 - 11 . doi: 10.1109/tim.2021.3135552 http://dx.doi.org/10.1109/tim.2021.3135552

CHANG W C . Robotic assembly of smartphone back shells with eye-in-hand visual servoing ［J］. Robotics and Computer-Integrated Manufacturing ， 2018 ， 50 ： 102 - 113 . doi: 10.1016/j.rcim.2017.09.010 http://dx.doi.org/10.1016/j.rcim.2017.09.010

LIU Z Y ， LIU X ， DUAN G F ， et al . Precise pose and radius estimation of circular target based on binocular vision ［J］. Measurement Science and Technology ， 2019 ， 30 （ 2 ）： 025006 . doi: 10.1088/1361-6501/aaf8c8 http://dx.doi.org/10.1088/1361-6501/aaf8c8

束安，裴浩东，周姗姗，等 . 非合作航天器的立体视觉位姿测量［J］. 光学精密工程， 2021 ， 29 （ 3 ）： 493 - 502 . doi: 10.37188/OPE.20212903.0493 http://dx.doi.org/10.37188/OPE.20212903.0493

SHU A ， PEI H D ， ZHOU SH SH ， et al . Stereo measurement of position and attitude of non-cooperative spacecraft ［J］. Opt. Precision Eng. ， 2021 ， 29 （ 3 ）： 493 - 502 . （in Chinese） . doi: 10.37188/OPE.20212903.0493 http://dx.doi.org/10.37188/OPE.20212903.0493

ZHENG Y ， LIU Y . Closed-form solution for circle pose estimation using binocular stereo vision ［J］. Electronics Letters ， 2008 ， 44 （ 21 ）： 1246 - 1247 . doi: 10.1049/el:20081165 http://dx.doi.org/10.1049/el:20081165

陈平，李灿，雷学军 . 3D视觉结合图像检测与导纳控制的圆轴孔零件机器人装配［J］. 控制与决策， 2022 ： 1 – 8 .

CHEN P ， LI C ， LEI X J . Robotic assembly of cylindrical shaft and hole parts based on 3D vison，image detection and admittance control ［J］. Control and Decision ， 2022 ： 1 - 8 . （in Chinese）

SONG R ， LI F M ， QUAN W ， et al . Skill learning for robotic assembly based on visual perspectives and force sensing ［J］. Robotics and Autonomous Systems ， 2021 ， 135 ： 103651 . doi: 10.1016/j.robot.2020.103651 http://dx.doi.org/10.1016/j.robot.2020.103651

SHAH G A ， POLETTE A ， PERNOT J P ， et al . Simulated annealing-based fitting of CAD models to point clouds of mechanical parts’ assemblies ［J］. Engineering With Computers ， 2021 ， 37 （ 4 ）： 2891 - 2909 . doi: 10.1007/s00366-020-00970-8 http://dx.doi.org/10.1007/s00366-020-00970-8

VOSSELMAN G ， GORTE B G ， SITHOLE G ， et al . Recognising structure in laser scanner point clouds ［J］. International archives of photogrammetry， remote sensing and spatial information sciences ， 2004 ， 46 （ 8 ）： 33 - 38 .

FORSMAN M ， BÖRLIN N ， OLOFSSON K ， et al . Bias of cylinder diameter estimation from ground-based laser scanners with different beam widths： a simulation study ［J］. ISPRS Journal of Photogrammetry and Remote Sensing ， 2018 ， 135 ： 84 - 92 . doi: 10.1016/j.isprsjprs.2017.11.013 http://dx.doi.org/10.1016/j.isprsjprs.2017.11.013

LANG L ， WANG J ， WEI Q ， et al . Compliant landing of a trotting quadruped robot based on hybrid motion/force robust control ［J］. Journal of Central South University ， 2016 ， 23 （ 8 ）： 1970 - 1980 . doi: 10.1007/s11771-016-3254-2 http://dx.doi.org/10.1007/s11771-016-3254-2

FOCCHI M ， MEDRANO-CERDA G A ， BOAVENTURA T ， et al . Robot impedance control and passivity analysis with inner torque and velocity feedback loops ［J］. Control Theory and Technology ， 2016 ， 14 （ 2 ）： 97 - 112 . doi: 10.1007/s11768-016-5015-z http://dx.doi.org/10.1007/s11768-016-5015-z

HOGAN N . Impedance Control： An Approach to Manipulation： Part I-Theory ［J］. Journal of Dynamic Systems， Measurement， and Control ， 1985 ， 107 （ 1 ）： 1 - 7 . doi: 10.1115/1.3140702 http://dx.doi.org/10.1115/1.3140702

ZHANG K G ， XU J ， CHEN H P ， et al . Jamming analysis and force control for flexible dual peg-in-hole assembly ［J］. IEEE Transactions on Industrial Electronics ， 2019 ， 66 （ 3 ）： 1930 - 1939 . doi: 10.1109/tie.2018.2838069 http://dx.doi.org/10.1109/tie.2018.2838069

HU H Y ， CAO J F . Adaptive variable impedance control of dual-arm robots for slabstone installation ［J］. ISA Transactions ， 2022 ， 128 ： 397 - 408 . doi: 10.1016/j.isatra.2021.10.020 http://dx.doi.org/10.1016/j.isatra.2021.10.020

PAPON J ， ABRAMOV A ， SCHOELER M ， et al . Voxel cloud connectivity segmentation - supervoxels for point clouds ［C］. Proceedings of the 2013 IEEE Conference on Computer Vision and Pattern Recognition . New York ： ACM ， 2013 ： 2027 - 2034 . doi: 10.1109/cvpr.2013.264 http://dx.doi.org/10.1109/cvpr.2013.264

STEIN S C ， SCHOELER M ， PAPON J ， et al . Object partitioning using local convexity ［C］. 2014 IEEE Conference on Computer Vision and Pattern Recognition. Columbus ， OH ， USA . IEEE ， 2014 ： 304 - 311 . doi: 10.1109/cvpr.2014.46 http://dx.doi.org/10.1109/cvpr.2014.46

SCHOELER M ， PAPON J ， WÖRGÖTTER F . Constrained planar cuts-Object partitioning for point clouds ［C］. 2015 IEEE Conference on Computer Vision and Pattern Recognition . Boston， MA， USA . IEEE ， 2015 ： 5207 - 5215 . doi: 10.1109/cvpr.2015.7299157 http://dx.doi.org/10.1109/cvpr.2015.7299157

AL-SHARADQAH A ， CHERNOV N . Error analysis for circle fitting algorithms ［J］. Electronic Journal of Statistics ， 2009 ， 3 ： 886 - 911 . doi: 10.1214/09-ejs419 http://dx.doi.org/10.1214/09-ejs419

KANATANI K ， RANGARAJAN P . Hyper least squares fitting of circles and ellipses ［J］. Computational Statistics & Data Analysis ， 2011 ， 55 （ 6 ）： 2197 - 2208 . doi: 10.1016/j.csda.2010.12.012 http://dx.doi.org/10.1016/j.csda.2010.12.012

NURUNNABI A ， SADAHIRO Y ， LAEFER D F . Robust statistical approaches for circle fitting in laser scanning three-dimensional point cloud data ［J］. Pattern Recognition ， 2018 ， 81 ： 417 - 431 . doi: 10.1016/j.patcog.2018.04.010 http://dx.doi.org/10.1016/j.patcog.2018.04.010

DEY E K ， AWRANGJEB M ， STANTIC B . Outlier detection and robust plane fitting for building roof extraction from LiDAR data ［J］. International Journal of Remote Sensing ， 2020 ， 41 （ 16 ）： 6325 - 6354 . doi: 10.1080/01431161.2020.1737339 http://dx.doi.org/10.1080/01431161.2020.1737339

HONG L ， CHEN G . Segment-based stereo matching using graph cuts ［C］. Proceedings of the 2004 IEEE Computer Society Conference on Computer Vision and Pattern Recognition ， Washington， DC， USA . IEEE . 2004 ， 1： I-I.

BORRMANN D ， ELSEBERG J ， LINGEMANN K ， et al . The 3D Hough Transform for plane detection in point clouds： a review and a new accumulator design ［J］. 3D Research ， 2011 ， 2 （ 2 ）： 3 . doi: 10.1007/3dres.02(2011)3 http://dx.doi.org/10.1007/3dres.02(2011)3

浏览量

1249

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

空间机器人在轨双臂辅助航天器对接力/位置嵌套双层滑模阻抗控制

数字散斑干涉应力应变同步测量

增强反射的被动非视域成像U-NET重构

中国仪器企业如何突破规模瓶颈

基于Mamba架构的遥感图像超分辨率重建方法综述