3D Map Reconstruction in Indoor Environment Based on Normal Distribution Transformation Under Gravity Constraint

doi:DOI: 10.16183/j.cnki.jsjtu.2018.01.005

Abstract

Abstract: A method for offline reconstruction of indoor 3D map is proposed based on an improved normal distribution transform (NDT) algorithm. First, a constraint in the gravity direction is incorporated into a 3D NDT, so that map deformation in extra dimensions is rectified. Then a cyclic gradient matching scheme is proposed to deal with the matching error resulted from scarce overlap between consecutive frames. Finally, a graph optimization is adopted in the back-end map construction. By using a swinging laser, experiments validate its performance and high accuracy.

Key words: indoor 3D map, reconstruction, gravity constraint, normal distributions transform (NDT), cyclic gradient matching, graph optimization

CLC Number:

TP 391.41

QI Mingxua,b,YANG Minga,b,WANG Chunxiangc,WANG Binga,b. 3D Map Reconstruction in Indoor Environment Based on Normal Distribution Transformation Under Gravity Constraint[J]. Journal of Shanghai Jiaotong University, 2018, 52(1): 26-32.

References

［1］MADDERN W, PASCOE G, NEWMAN P. Leveraging experience for large-scale LIDAR localisation in changing cities［C］∥IEEE International Conference on Robotics and Automation (ICRA). Washington, USA: IEEE, 2015: 1684-1691. ［2］YONEDA K, TEHRANI H, OGAWA T, et al. Lidar scan feature for localization with highly precise 3-D map［C］∥IEEE Intelligent Vehicles Symposium Proceedings. Dearborn, USA: IEEE, 2014: 1345-1350. ［3］肖已达, 王冰, 杨明, 等. 基于激光雷达的道路可通行区域检测［J］. 机电一体化, 2013, 19(2): 62-66. XIAO Yida, WANG Bing, YANG Ming, et al. The detection of road traffic zone based on laser radar［J］. Mechatronics, 2013, 19 (2): 62-66. ［4］BUONOCORE L, SANTOS S R B D, NETO A A, et al. FastSLAM filter implementation for indoor autonomous robot［C］∥IEEE Intelligent Vehicles Symposium (IV). Gothenburg, Sweden: IEEE, 2016: 484-489. ［5］REDONDO E L, MARTINEZ-MARIN T. A compact representation of the environment and its frontiers for autonomous vehicle navigation［C］∥IEEE Intelligent Vehicles Symposium (IV). Gothenburg, Sweden: IEEE, 2016: 851-857. ［6］WULF O, WAGNER B. Fast 3D scanning methods for laser measurement systems［C］∥International Conference on Control Systems & Computer Science, 2003: 1-6. ［7］YOSHIDA T, IRIE K, KOYANAGI E, et al. 3D laser scanner with gazing ability［C］∥IEEE International Conference on Robotics and Automation. Shanghai, China: IEEE, 2011, 47(10): 3098-3103. ［8］谷晓杰,卜春光,陈成,等. 三维激光测距系统设计与标定方法研究［J］. 沈阳理工大学学报, 2014, 33(5): 10-14. GU Xiaojie, BU Chunguang, CHEN Cheng, et al. Design, implementation and calibration of 3-D LIDAR scanning system［J］. Journal of Shenyang Ligong University, 2014, 33(5): 10-14. ［9］ROHDE J, JATZKOWSKI I, MIELENZ H, et al. Vehicle pose estimation in cluttered urban environments using multilayer adaptive Monte Carlo localization［C］∥International Conference on Information Fusion. Heidelberg, Germany: IEEE, 2016. ［10］POMERLEAU F, COLAS F, SIEGWART R, et al. Comparing ICP variants on real-world data sets［J］. Autonomous Robots, 2013, 34(3):133-148. ［11］MAGNUSSON M, LILIENTHAL J A, DUCKETT T. Scan registration for autonomous mining vehicles using 3D-NDT［J］. Journal of Field Robotics, 2007, 24(10):803-827. ［12］MAGNUSSON M, NCHTER A, LRKEN C, et al. Evaluation of 3D registration reliability and speed—A comparison of ICP and NDT［C］∥IEEE International Conference on Robotics and Automation. Kobe, Japan: IEEE, 2009: 3907-3912. ［13］DRYANOVSKI I, VALENTI R G, XIAO J Z. Fast visual odometry and mapping from RGB-D data［C］∥IEEE International Conference on Robotics and Automation. Karlsruhe, Germany: IEEE, 2013: 2305-2310. ［14］KMMERLE R, GRISETTI G, STRASDAT H, et al. g2o: A general framework for graph optimization［C］∥IEEE International Conference on Robotics and Automation. Shanghai, China: IEEE, 2011: 3607-3613.

[1]	LI Jianjun, ZHU Wenfeng, SUN Haitao, LI Yuanhui, WANG Shunchao. Method of Curing Deformation Prediction and Surface Reconstruction Compensation for Roller-Hemming Structures with Dissimilar Materials [J]. Journal of Shanghai Jiao Tong University, 2022, 56(7): 965-976.
[2]	LIU Zhuoran (刘卓然), ZHAO Xu∗ (赵旭). Multilevel Disparity Reconstruction Network for Real-Time Stereo Matching [J]. J Shanghai Jiaotong Univ Sci, 2022, 27(5): 715-722.
[3]	ZHANG Mingzhu(张明珠), MA Yixin* (马艺馨), HUANG Ningning (黄宁宁), GE Hao (葛浩). Survey of EIT Image Reconstruction Algorithms [J]. J Shanghai Jiaotong Univ Sci, 2022, 27(2): 211-218.
[4]	YUAN Haobo, DONG Xinxin, ZHANG Ruixue, LU Lanpu, CHEN Xi. A Probe Correction Technique for Near Field to Far Field Transform Based on Sources Reconstruction Method [J]. Journal of Shanghai Jiao Tong University, 2022, 56(11): 1541-1546.
[5]	WANG Jinwu,LI Tao,XU Yuanjing,LI Shuai,REN Ya,DAI Kerong. Biological 3D Printing and Organ Reconstruction [J]. Journal of Shanghai Jiao Tong University, 2021, 55(Sup.1): 46-48.
[6]	YANG Chenghao (杨成昊), LU Xinwu (陆信武), JIANG Wenbo (姜闻博), YE Kaichuang (叶开创), ZHAO Zhen (赵振), WANG Xuhui (王旭辉), WANG Penghui (王鹏辉), FEI Yebao (费业宝), WANG Wei (王伟), YIN Minyi (殷敏毅). Application of 3D Digital Reconstruction and Printing to the Diagnosis and Treatment of Iliac Vein Compression [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(3): 312-318.
[7]	SUN Xiaojiang(孙晓江), ZHAO Changqing (赵长清), YANG Erzhu(杨二柱), LI Hua (李华), ZHANG Kai (张凯), CHENG Xiaofei(程晓非), JIANG Wenbo (姜闻博), CHENG Zhihua(程志华), GUO Zhilin (郭智霖), DAI Kerong (戴尅戎), ZHAO Jie (赵杰). Technique Note for Staged Resection of Giant Invasive High-Cervical Schwannoma and Reconstruction of C2—C4 with 3D Printing Technique [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(3): 325-333.
[8]	WU Junxiang (吴钧翔), LUO Dinghao(罗丁豪), XIE Kai (谢凯), WANG Lei (王磊), HAO Yongqiang (郝永强). Design and Application of 3D Printing Based Personalised Pelvic Prostheses [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(3): 361-367.
[9]	GE Weiwen (葛卫文), WANG Yun (王昀), GE Kui(葛奎), WU Jiajun (吴嘉骏), FAN Jingxian (范晶娴), YANG Tianye(杨天页), WANG Qi (王齐), XU Bing (徐兵). Application of Virtual Reconstruction 3D-Printed External Fixation Helmet in Early Functional Treatment of Facial Fracture [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(3): 368-371.
[10]	WANG Zhikai, CHEN Jin, YAO Xiongliang, JIANG Zifei. A Structural Reconstruction Method of Large Ship Based on Grey Theory [J]. Journal of Shanghai Jiao Tong University, 2021, 55(11): 1429-1437.
[11]	HUANG Ningning (黄宁宁), MA Yixin (马艺馨), ZHANG Mingzhu (张明珠), GE Hao (葛浩), WU Huawei (吴华伟). Finite Element Modeling of Human Thorax Based on MRI Images for EIT Image Reconstruction [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(1): 33-39.
[12]	ZHU Dong, JIANG Pingping, YAN Guozheng, WANG Zhiwu, HAN Ding, ZHAO Kai, HUA Fangfang, YAO Shengjian, DING Zifan, ZHOU Zerun. Defecation Perception Reconstruction of an Artificial Anal Sphincter System [J]. Journal of Shanghai Jiaotong University, 2020, 54(8): 771-777.
[13]	SHE Wenxuan, GUO Chunyu, ZHOU Guangli, WU Tiecheng, XU Peng. Time-Resolved PIV Measurements and Numerical Study of Water Entry of a Wedge [J]. Journal of Shanghai Jiaotong University, 2020, 54(8): 839-848.
[14]	DAI Cong, LIU Yongzhi, SUN Haoshui . Fault Reconstruction for Lipschitz Nonlinear Systems Using Higher Terminal Sliding Mode Observer [J]. Journal of Shanghai Jiao Tong University(Science), 2020, 25(5): 630-638.
[15]	CHEN Jichi, WEI Guohua, GUO Conglong, ZHANG Lihe. Preliminary Study on a Deep Learning 3D Reconstruction Simulation Method Based on Infrared Image Sequence [J]. Air & Space Defense, 2020, 3(4): 21-29.