Initial version of pathfinding - fixed SolderPen