Renamed FAST_writeRgbPixel to FAST_writeRgb565Pixel
Cosmetics
Added default case for switch - should never happens, but might cause optimization bonus
Cosmetics
Removed FAST_TESTIFY defs
Hopefully corrected invalid target coords/mass return
Split ball detector into three sources: reference implementation, sequential implementation and single step implementation