Optics and Precision Engineering, Volume. 31, Issue 21, 3135(2023)

Visual 6D pose estimation of battery package locking mechanism in intelligent battery swapping station

Lihui WANG1,*... Yuzuwei SU1, Chunhua HAN2, Liangliang CHEN3 and Hao ZHANG3 |Show fewer author(s)
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

    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.

    Tools

    Get Citation

    Copy Citation Text

    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

    EndNote(RIS)BibTexPlain Text
    Save article for my favorites
    Paper Information

    Category:

    Received: Feb. 26, 2023

    Accepted: --

    Published Online: Jan. 5, 2024

    The Author Email: WANG Lihui (wangyi_sy1256@163.com)

    DOI:10.37188/OPE.20233121.3135

    Topics