Fixed comparison error, roadmap generation

global planning is commented out for now, causes a crash somewhere.