Froctomap now initializes to 0.5
Froctomap now initializes to 0.5