Fixade så rätt noder ingår i pathen efter Dijkstras.
Plockar ut pathen till mainen för att enklare kunna göra om från nod-nummer till "GPS-kommandon".
Rensat lite i koden och sett till att olika riktningar på hyllorna hanteras på olika sätt (startat på...)