Pathfinding optimization #4

Replace tuple with pair, with constant access to the members without
having to use std::get