3pi Robot Santa Fe Trail Problem

Environment

  • Ubuntu 16.04
  • Pololu 3pi Robot (ATmega328P)

C code

Result