Попытка определить время максимума каждого импульса

Question

Привет. Я пытаюсь написать код, способный считывать пиковое значение аналогового датчика с течением времени. Необходимая функция объясняется на рисунке. Это код, который у меня есть, но он не работает. Был бы признателен за некоторые рекомендации по этому вопросу. Спасибо!

const int sensorpin1= A0;
int sensorvalue1=0;
int Max1=0;
unsigned long time1=0;
int thres=150;

void setup() {
  Serial.begin(9600);
}

void loop() {   
  sensorvalue1 = analogRead(sensorpin1);
  if(sensorvalue1 > Max1) {
    Max1= sensorvalue1;
    time1=millis();
  }
  if(sensorvalue1<=thres && Max1 > thres)  {
    Serial.print(Max1);
    Serial.print("\t");
    Serial.println(time1);

    Max1=0;
  }
}

[1]: https://i.stack.imgur.com/gztNs.png