Research on Attitude Estimation of Rocket Propellant Filling Robots Based on Lidar#br#

doi:10.3969/j.issn.1004-132X.2021.10.008

China Mechanical Engineering ›› 2021, Vol. 32 ›› Issue (10): 1200-1204.DOI: 10.3969/j.issn.1004-132X.2021.10.008

Previous Articles Next Articles

Research on Attitude Estimation of Rocket Propellant Filling Robots Based on Lidar#br#

LU Yu1;JIANG Zan2;HONG Gang2;DUN Xiangming1

1. School of Mechanical Engineering, Shanghai Jiao Tong University, Shanghai, 200240
2. 805th Institute of Shanghai Academy of Spaceflight Technology, Shanghai, 201108

Online:2021-05-25 Published:2021-06-10

基于激光雷达的火箭推进剂加注机器人姿态估计研究

陆煜1;蒋赞2;洪刚2;顿向明1

1. 上海交通大学机械与动力工程学院，上海，200240
2. 上海航天技术研究院第805研究所，上海，201108

通讯作者: 顿向明（通信作者），男，1964年生，教授。研究方向为特种机器人设计。E-mail:xmdun@sjtu.edu.cn。
作者简介:陆煜，男，1996年生，硕士研究生。研究方向为机器人定位跟踪。E-mail:luyu19960806@sjtu.edu.cn。

Abstract

Abstract: To realize the demands of automatic docking in the filling processes of fuel propellant in the launch of carrier rockets, an attitude estimation algorithm was proposed based on single-line lidar. The two-dimensional lidar was rotated by a motor, and the three-dimensional point cloud information of the environment was collected. The target boards with special geometry shapes were identified by the proposed algorithm to determine the relative attiudes between the filling robots and the arrow valves, and the attitude estimation of the robots was realized based on artificial beacon. Finally, the reliability and accuracy of the proposed algorithm were verified by experiments.

Key words: propellant filling, lidar, artificial beacon, attitude estimation

摘要： 针对运载火箭发射中燃料推进剂加注环节中的自动对接需求，提出了一种基于单线激光雷达识别人工信标的姿态估计算法。通过电机带动二维激光雷达旋转，采集环境三维点云信息，通过所提算法从中识别出具有特殊几何形状的目标板来确定加注机器人与箭体活门之间的相对姿态，并实现机器人基于人工信标的姿态估计。最后通过实验验证了所提算法的可靠性与准确性。

关键词: 推进剂加注, 激光雷达, 人工信标, 姿态估计

CLC Number:

TP242.6

LU Yu, JIANG Zan, HONG Gang, DUN Xiangming. Research on Attitude Estimation of Rocket Propellant Filling Robots Based on Lidar#br#[J]. China Mechanical Engineering, 2021, 32(10): 1200-1204.

陆煜, 蒋赞, 洪刚, 顿向明. 基于激光雷达的火箭推进剂加注机器人姿态估计研究[J]. 中国机械工程, 2021, 32(10): 1200-1204.

References

［1］顿向明, 山磊, 陆晋荣, 等.探究火箭推进剂加注机器人［J］.机器人产业, 2015(5):86-93.
DUN Xiangming, SHAN Lei, LU Jinrong, et al. Research on the Rocket Propellant Refueling Robot［J］. Robot Industry, 2015(5):86-93.
［2］赵金才. ××型号火箭推进剂重大泄漏事故抢险组织指挥的启示［C］//全国灾害医学学术会议暨华森杯灾害医学优秀学术论文评审会. 上海，2007：24-27.
ZHAO Jincai. Enlightenment from Command of Emergency Rescue Organization for Model ×× Rocket Propellant Leakage［C］//National Disaster Medicine Academic Conference & Watson Cup Disaster Medicine Outstanding Academic Paper Review Conference. Shanghai，2007：24-27.
［3］闻靖，顿向明，张育林，等. 推进剂加注自动对接与脱离机器人技术现状与发展趋势研究［J］. 机器人技术与应用, 2010(6):20-23.
WEN Jing, DUN Xiangming, ZHANG Yulin, et al. Research on Technology Status and Development Trend of Auto-docking and Auto-seqarating Robot for Launch Vehicle Propellant Loading［J］. Robot Technology and Application, 2010(6):20-23.
［4］DANDAGE S R, HERMAN N A, GODFREY S E, et al. Design and Development of the Space Shuttle Tail Service Masts, NASA 79-21357［R］. Washington D C:NASA, 1979.
［5］UDA R T. Space Shuttle Tail Service Mast Concept Verification, NASA 76-28273［R］. Washington D C:NASA, 1976.
［6］VALKEMA D C. Umbilical Connect Techniques Improvement Technology Study, NASA 10-7702［R］. Washington D C:NASA, 1972.
［7］王立兴.俄罗斯火箭脐带自动对接技术评析［J］.航天发射技术，2003(1)：45-50.
WANG Lixing. The Technical Analysis on Automated Connection of Russians Rocket Umbilical Cord［J］. Space Launch Technology, 2003(1):45-50.
［8］黄小妮，顿向明，张育林，等. 运载火箭推进剂加注自动对接与脱离机器人本体设计［J］. 机器人，2010, 32(2):145-149.
HUANG Xiaoni, DUN Xiangming, ZHANG Yulin, et al. The Auto-docking and Auto-separating Mechanism Designed for the Rocket Fuel Loading［J］. Robot, 2010, 32(2):145-149.
［9］赵帅锋，顿向明，张育林，等. 运载火箭推进剂加注自动对接与脱离机器人自动上箭模块控制系统的设计与实验［J］. 机器人，2012, 34(3):307-313.
ZHAO Shuaifeng, DUN Xiangming, ZHANG Yulin, et al. Design and Experiment of the Control System for Automatic Rocket-attaching Module of Auto-docking and Auto-separating Robot for Launch Vehicle Propellant Loading［J］. Robot, 2012, 34(3):307-313.
［10］游嘉伟，顿向明，山磊，等. 运载火箭推进剂加注机器人机构设计［J］. 机电一体化，2016, 22(4):41-44.
YOU Jiawei, DUN Xiangming, SHAN Lei, et al. Mechanism Design of Carrier Rocket Propellant Filling Robot［J］. Mechatronics, 2016, 22(4):41-44.
［11］BRSCIC D， HASHIMOTO H. Tracking of Objects in Intelligent Space Using Laser Range Finders［C］//2006 IEEE International Conference on Industrial Technology. Mumbai, 2006:1723-1728.
［12］BLACKMAN S, POPOLI R. Design and Analysis of Modern Tracking Systems ［M］. Norwood:Artech House, 1999:11-14.
［13］黄小平. 卡尔曼滤波原理及应用［M］. 北京:电子工业出版社, 2015.
HUANG Xiaoping. Kalman Filtering Principle and Application［M］. Beijing:Publishing House of Electronics Industry, 2015.

[1]	FANG Dehao1;XU Wan1;CHEN Youping2;YU Leitao1;ZHU Li1. Fitting Method of Reflector Positions Based on Lidar Echo Intensity [J]. China Mechanical Engineering, 2021, 32(02): 204-211.
[2]	WANG Hai, ZHENG Zhengyang, CAI Yingfeng, CHEN Long. Obstacle Detection Algorithm for Driverless Vehicles Based on Four-layer Lidars [J]. China Mechanical Engineering, 2018, 29(15): 1884-1889.
[3]	FENG Chun, TUN Hong-Chao, CHEN Bai, JIAO Bing. Closed-Form Method for Relative Pose Parameters between Chaser and Target Spacecraft Based on Quaternion [J]. China Mechanical Engineering, 2013, 24(12): 1655-1660.
[4]	MAN Ceng-Guang, XIE Wen-Hua, LOU Pei-Huang, XIAO Hai-Ning. Feature Extraction Based on Split-merge in Range Image of LIDAR [J]. China Mechanical Engineering, 2011, 22(19): 2303-2306.

Research on Attitude Estimation of Rocket Propellant Filling Robots Based on Lidar#br#

基于激光雷达的火箭推进剂加注机器人姿态估计研究

PDF

Knowledge

Abstract

Cite this article

share this article

References

Related Articles 4

Recommended Articles

Metrics