insertRay deteriorate the true map

Hi All,

When I analyze the example "Dynamic Replanning on an Indoor Map", it's seen that the originally occupied areas change to free space after insertRay function. Namely, this clearly ruin the original map. So is there a solution for this?

And how to get exact locations that insertRay functions placed after given range/angles couples.