SLAM with occupancy grid and particle filter, using lidar, joints, IMU and odometry data from THOR humanoid robot