Optimizer the road fucntions to fix the draw path bug; This version is for test