Added function to update the DF from an octree. Fixed old bug to update from collision map (fixed in other branches).