Implemented a mapping and localization algorithm for the THOR-OP robot operated on the 4th floor of Levine Building here at UPenn. The mapping and localization was applied by using information from inertial, odometery and LIDAR sensor data to build a 2D occupancy grid map of teh walls and obstacles in the environemnt.