Modify SimpleOccupancyGrid::addScan in occupancy_grid.cc to perform
C-space expansion.

me132_tutorial_planning.cc is the main file. Call your path planner where it
indicates in the loop.