[Courtesy: University of Waterloo]
In this video, an Aeryon Scout, mounted with a Hokuyo URG lidar, builds a 3D occupancy grid map of our lab environment using the Octomap library. Vehicle localization in x, y, z, and yaw are performed though an Optitrack system, while roll and pitch are obtained through on-board IMU estimates.