Код для получения PWM-вывода

Я попробовал код для получения ШИМ-выхода 100 кГц с рабочим циклом 41,66%, считав аналоговое значение из A0, которое сравнивается с эталонным значением 5 В для получения значения ШИМ.

Кто-нибудь может помочь мне с кодом? Любая помощь очень ценится.

Вот мой код.

int Pwmpin=9;//Pwm Output Pin
int Fchange= A0;//Изменение частоты с помощью потенциометра

void setup() {
  pinMode(Pwmpin, OUTPUT);//Pwm pin as Output
  Serial.begin(9600);
  TCCR1A=_BV(COM1A1)|_BV(COM1B1);//Non-inverted Mode
  TCCR1B=_BV(WGM13)|_BV(CS11);//Prescalar 8
}

void loop(){
  float freq=0;
  float count=10000,countt=0,Pinput=0;
  while(1){
    ICR1=count;//переменная частота
    countt=16*count;
    freq= int(16000000/countt);
    OCR1A=int(count/2);
    Serial.print("Pwm Freq =");
    Serial.println(freq);
    count=10000;
    Pinput=analogRead(A0);//Считанное входное значение
    Serial.print("adc value is:");
    Serial.println(Pinput);
    Pinput=(Pinput/0.0113);
    Serial.print("pwm value is:");
    Serial.println(Pinput);
    count=count+Pinput;
    if(count>=100000) {
      count=10000;
    }
    delay(1000);
  }
}