Changed map expansion and optimization levels
removed costmap from wayclear function