I've got a problem with the code not detecting gear 5 and 6.
It recognizing gear 5 as gear 3 and gear 6 as reverse or gear 4.
I've already tried reading out the x/y coordinates and then setting a custom calibration but with no luck.
It just does not want to recognize the gears.

I'm using your custom pcb with a sparkpro.