Modifies printMatrix method (clearer display)
Algorithm now searches in 4 directions (from 8)
Changes heuristic function (now manhattan distance)
Merge branch 'master' of https://github.com/SupelecRobotics/RobotsSUMO2017