• Optics and Precision Engineering
  • Vol. 31, Issue 21, 3135 (2023)
Lihui WANG1,*, Yuzuwei SU1, Chunhua HAN2, Liangliang CHEN3, and Hao ZHANG3
Author Affiliations
  • 1Key Laboratory of Micro-inertial Instrument and Advanced Navigation Technology, Ministry of Education, School of Instrument Science and Engineering, Southeast University, Nanjing20096, China
  • 2Jiangsu Provincial Electric Power Corporation, Nanjing1004, China
  • 3NARI Technology Company Ltd., Nanjing211100, China
  • show less
    DOI: 10.37188/OPE.20233121.3135 Cite this Article
    Lihui WANG, Yuzuwei SU, Chunhua HAN, Liangliang CHEN, Hao ZHANG. Visual 6D pose estimation of battery package locking mechanism in intelligent battery swapping station[J]. Optics and Precision Engineering, 2023, 31(21): 3135 Copy Citation Text show less

    Abstract

    In order to meet the battery replacement demand of electric vehicles, a 6D pose estimation method of battery package locking mechanism based on point cloud segmentation is proposed to solve the positioning problem of locking mechanism during battery package docking in battery swapping station. This method uses YOLOv5 network to segment the point cloud of locking mechanism from the scene, and uses voxel filtering and moving least square fitting to filter and smooth the point cloud. The point cloud labels are predicted by the point cloud segmentation network, and the global semantic feature is added to the Fast Point Feature Histograms (FPFH) feature to make up for the defect that the FPFH has only the local feature of the point cloud. According to this feature, the Random Sample Consensus (RANSAC) rigid point cloud registration is leveraged, and the 6D pose of the locking mechanism point cloud is estimated. Finally, the Iterative Closest Point(ICP) algorithm is used to correct the pose estimation results. The experimental results show that the 6D pose estimation algorithm of locking mechanism based on point cloud segmentation has high accuracy, and can overcome the mismatching caused by environmental noise, and accurately obtain the position and attitude of locking mechanism. The angle error of position and attitude estimation can reach 1.90°, the displacement error can reach 1.4 mm, and the RMSE can reach 1.5 mm, which provides an effective solution for battery docking positioning in battery swapping station.
    Lihui WANG, Yuzuwei SU, Chunhua HAN, Liangliang CHEN, Hao ZHANG. Visual 6D pose estimation of battery package locking mechanism in intelligent battery swapping station[J]. Optics and Precision Engineering, 2023, 31(21): 3135
    Download Citation