• Optics and Precision Engineering
  • Vol. 30, Issue 22, 2889 (2022)
Ping CHEN*, Xuejun LEI, Can LI, Yiliang HU, and Shuang CHEN
Author Affiliations
  • College of Mechanical and Vehicle Engineering, Chongqing University, Chongqing400044, China
  • show less
    DOI: 10.37188/OPE.20223022.2889 Cite this Article
    Ping CHEN, Xuejun LEI, Can LI, Yiliang HU, Shuang CHEN. Assembly of countersunk-hole parts based on 3D pose estimation and impedance control[J]. Optics and Precision Engineering, 2022, 30(22): 2889 Copy Citation Text show less

    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.
    ωi=1η2πe-kdi22η2,i=1,2,...,n(1)

    View in Article

    di=(xi-x¯)2+(yi-y¯)2+(zi-z¯)2(2)

    View in Article

    Sw=1miPwωi(3)

    View in Article

    ϕi=ωrIi+ωnθi(4)

    View in Article

    yp=BA(xp-x0)+y0(5)

    View in Article

    zp=CA(xp-x0)+z0(6)

    View in Article

    xp=(B2+C2)x0-A(By0+Cz0+D)A2+B2+C2(7)

    View in Article

    yp=(A2+C2)y0-B(Ax0+Cz0+D)A2+B2+C2(8)

    View in Article

    zp=(A2+B2)z0-C(Ax0+By0+D)A2+B2+C2(9)

    View in Article

    a(x2+y2)+bx+cy+d=0(10)

    View in Article

    x-b2a2+y-c2a2-b2+c2-4ad4a2=0(11)

    View in Article

    xcircle=-b2a,ycircle=-c2a(12)

    View in Article

    R2=b2+c2-4ad4a2(13)

    View in Article

    PM=z1x1y11zixiyi1znxnyn1(14)

    View in Article

    M=1nPMTPM=z¯z¯z¯x¯z¯y¯z¯z¯x¯x¯x¯x¯y¯x¯z¯y¯x¯y¯y¯y¯y¯z¯x¯y¯1(15)

    View in Article

    z¯z¯=1ni=1nzizi(16)

    View in Article

    N=8z¯4x¯4y¯24x¯1004y¯0102000(17)

    View in Article

    Mde˙+Bde¨+Kde=-F(18)

    View in Article

    RMSEΔd=1ni=1ndi212(19)

    View in Article

    RMSEΔθ=1ni=1nθi212(20)

    View in Article

    Ping CHEN, Xuejun LEI, Can LI, Yiliang HU, Shuang CHEN. Assembly of countersunk-hole parts based on 3D pose estimation and impedance control[J]. Optics and Precision Engineering, 2022, 30(22): 2889
    Download Citation