//LAP COUNTER SETUP /////////////////////////////////////////////////// const int dlen = 4; //number of samples averaged double d[dlen] = {0}; // need a 0 for every sample to average void pushd(double val) { for (int i = 1; i < dlen; i++) { d[i-1] = d[i]; } d[dlen - 1] = val; //Serial.print ("val: "); /// same as ad //Serial.println (val,3); } double avgd() { double sum = 0; for (int i = 0; i < dlen; i++) { sum = sum + d[i]; // adds previous lap to sum //Serial.print ("d[i]: "); //Serial.println (d[i],3); //Serial.print ("sum: "); //Serial.println (sum,3); } double average = sum / (double)dlen; return average; }