Commented code, worked with sensor main loop. Something wrong...
Tried to fix counters
Fixed counters, for real this time
Merged SensorMainTest back into master, message buffer works, counter works.