[5] [5] HALTERMAN R, BRUCH M.Velodyne hdl-64e lidar for unmanned surface vehicle obstacle detection［C］// Unmanned Systems Technology XII.International Society for Optics and Photonics, 2010, 7692: 76920D.

[6] [6] LEE K W, KALYAN B, WIJESOMA S, et al.Tracking random finite objects using 3D-LIDAR in marine environ-ments［C］//Proceedings of the 2010 ACM Symposium on Applied Com-puting.ACM, 2010: 1282-1287.

[8] [8] http: //www.velodynelidar.com/vlp-16.html

[9] [9] RUSU R B, MARTON Z C, BLODOW N, et al.Towards 3D point cloud based object maps for household environ-ments［J］.Robotics and Autonomous Systems, 2008, 56(11): 927-941.

[11] [11] BENTLEY J L.Multidimensional binary search trees used for associative searching［J］.Communi-cations of the ACM, 1975, 18(9): 509-517.

[12] [12] BERGEN G.Efficient collision detection of complex deformable models using AABB trees［J］.Journal of graphics tools, 1997, 2(4): 1-13.