Program fully linked. Only thing left is to fix pathing algorithm