flipflop

#pragma config(Sensor, S3,     kosketus1,           sensorTouch)

task main()
{
  int kosketus2Value=0;
  int flipflop=0;
  int apu=0;
  int askel=0;
  while(true)
  {
    kosketus2Value = SensorValue(kosketus1);
    if(kosketus2Value==1&&apu==0)
    {
      flipflop=1;
      apu=1;
    }
    if(kosketus2Value==0&&flipflop==1)
    {
      apu=2;
    }
    if(kosketus2Value==1&&apu==2)
    {
      flipflop=0;
      apu=3;
    }
    if(kosketus2Value==0&&apu==3)
    {
      apu=0;
    }
    if(flipflop==1)
    {
       if(aksel==1)
       {

          if(valmis)
          {
             askel=2;
          }
       }
       if(askel==2)
       {

       }
    /*
       tänne ajotoiminnot
    */
    }
    else
    {
      /*
       tänne pysäytykset
      */
    }
  }
}

#pragma config(Sensor, S3,     kosketus1,           sensorTouch)

int flipflop=0;
int flipAskel=0;
int FlipFlopToiminto();

task main()
{
  int toimii;
  while(true)
  {     toimii=FlipFlopToiminto();
     if(toimii==1)
     {
     /*
       tänne ajotoiminnot
     */
     }
     else
     {
      /*
       tänne pysäytykset
      */
     }
  }
}

int FlipFlopToiminto()
{
  int kosketus2Value=0;

    kosketus2Value = SensorValue(kosketus1);
    if(kosketus2Value==1&&flipAskel==0)
    {
      flipflop=1;
      flipAskel=1;
    }
    if(kosketus2Value==0&&flipflop==1)
    {
      flipAskel=2;
    }
    if(kosketus2Value==1&&flipAskel==2)
    {
      flipflop=0;
      flipAskel=3;
    }
    if(kosketus2Value==0&&flipAskel==3)
    {
      flipAskel=0;
    }

}