experimental routing algorithm changes, route printf and bug fix to draw.c