Optimisation of Djisktra