Better routing node selection and improve path accuracy

This is a fix suggestion for the #27 issue
https://github.com/graphhopper/graphhopper/issues/27