Resolve mapping bug

When the robot makes a 180 turn than the map is not corect. Now the previous cell is also updated