Better routing node selection and improve path accuracy

This is a fix suggestion for the https://github.com/graphhopper/graphhopper/issues/27 issue

Note that I am not 100% sure of my last merge with /master as I am quite new to Git's world.
Better be careful when merging my modifications that none of yours are lost.