ADC, diodes and servo up and runnig, voliatile optimizationshitproblem back again