Added direction from waypoint info
Fixed type in ArrayParser
Changed some types from int to uint32_t