Made some teaks. Still need ADC filtering and resistors