Fix map area not being fully freed when current scan is in it

• Do a "hard reset" of map pixels --> call PixelValue constructor instead of only resetting parts of its member variables holding occupancy information
• Initial fill-in of current scan into updated map as mapping does when started (take first scan, insert it, even-though robot isn't moving)