Path finding con Arduino

Ciao a tutti,
un pò di tempo fa avevo aperto un topic (questo) in cui chiedevo aiuto per un algoritmo di path finding su arduino. Il risultato di quel topic è stato che avrei dovuto riscrive tutto da capo...

Ed è quello che ho fatto, il terzo tentativo è stato quello buono, per ora sembra funzionare tutto come dovrebbe.

Lascio il codice in allegato per chi fosse interessato. Adesso devo provvedere a modificare tutto per utilizzare la sram esterna 23K256 e magari memorizzare la mappa su una EEPROM come la 24LC256.

NAV_TEST_V3.ino (8.12 KB)