Enahncements

Add more debug data through serial
Add capability to offset ADC measurement