Navigation solver based on lanes graph

[riccardosavorgnan]

Add a solver that given current position A and goal position B solves the shortest path from A to B based on the lanes graph (plus some rules for lane switching, u turns etc).

Could be useful for:

• Benchmarking navigation skills;
• Inducing/defining lane rewards;