#include <Servo.h>
Servo servo;
#define SET0(REG,BIT) REG &= ~(1<<BIT)
#define SET1(REG,BIT) REG |= (1<<BIT)
int cislo;

void ConvertToPercentage(float percentage){
  return percentage*1.80;
}


void setup() {
   SET0(ADMUX,REFS1); 
   SET0(ADMUX,REFS0);
   SET0(ADMUX,ADLAR); 
   SET0(ADMUX,MUX0); 
   SET0(ADMUX,MUX1);
   SET0(ADMUX,MUX2);
   SET0(ADMUX,MUX3);
   SET1(ADCSRA,ADEN); 
   SET1(ADCSRA,ADATE); 
   SET1(ADCSRA,ADIE); 
   SET1(SREG,7); 
   SET1(ADCSRA,ADPS2); 
   SET1(ADCSRA,ADPS1);
   SET1(ADCSRA,ADPS0);
   SET1(ADCSRA,ADSC); 
   servo.attach(2);
   Serial.begin(9600);
   servo.write(90);
}


ISR(ADC_vect)
{
  SET1(ADCSRA,ADSC); 
  cislo = ADCL; 
  cislo = cislo | (ADCH<<8); 
  Serial.println(cislo);
  servo.write(cislo);
  
  delay(10);
}



void loop() {
  // put your main code here, to run repeatedly:

}