flood fill algorithm
Merge https://github.com/tophertech/IEEE_ROBOTC_Micromouse