ADC reading, motor control work perfectly