Napin painallusten määrän tunnistus

int NapsautuksienLaskeminen();

task main()
{
  int napsautustenMaara=0;
  ClearTimer(T1);
  while(1)//ikuinen silmukka alkaa tasta
    {
      napsautustenMaara=NapsautuksienLaskeminen();
          if(1==napsautustenMaara)//testataan koko ajan kayttajan halua ajaa robottia
          {
            nxtDisplayBigStringAt(0, 20, "%d", napsautustenMaara);       
          }
          if(2==napsautustenMaara)
          {
            nxtDisplayBigStringAt(0, 20, "%d", napsautustenMaara);              
          }
          if(3==napsautustenMaara)
          {
            nxtDisplayBigStringAt(0, 20, "%d", napsautustenMaara);      
          }    
          wait10Msec(200);
          eraseDisplay();      
          wait10Msec(200);
          nxtDisplayBigStringAt(0, 40, "nyt p");
    }//ikuinen silmukka loppuu tahan
}

int NapsautuksienLaskeminen()
{
    int anturi=0,apu=0,laskuri=0;
    ClearTimer(T2);
    while(time1[T2]<2000)//odotellaan kaksi sekuntia ja lasketaan sina aikana tulleet anturin painallukset
    {
      anturi = SensorValue(kosketus1);
      if(apu==0 && anturi==1)//haetaan anturin nouseva reuna eli lasketaan vain yhdella ylospain kun anturia painettu
      {
        laskuri++;
        apu=1;
      }
      if(anturi==0){apu=0;}
    }
    return laskuri;
}