/* Switch Input Test */

#include "src/micomsub.h"

#include <stdio.h>


int SwA1,SwP1,SwF1,SwA2,SwP2,SwF2;

#define SwCNT 4 // チャタリング防止のためのカウント
#define SwHIGH LOW
#define SwLOW  HIGH

void SwInit()
{
    SwA1=0;
    SwP1=0;
    SwA2=0;
    SwP2=0;
}

void SwChkInc()
{
    SwF1=digitalRead(SWF1);
    SwF2=digitalRead(SWF2);

    if ((SwF1==SwHIGH) && (SwA1>=0)) { SwA1++; }
    if ((SwF2==SwHIGH) && (SwA2>=0)) { SwA2++; }

    if ((SwF1==SwLOW) && (SwA1>SwCNT)) { SwA1=0; SwP1++;  }
    if ((SwF2==SwLOW) && (SwA2>SwCNT)) { SwA2=0; SwP2++;  }

}

void setup(void)
{
    pinMode(SWF1,INPUT);
    pinMode(SWF2,INPUT);

    SwInit();

    //      0123456789012345
    printf("Switch Input TS\n");
    printf("1:000 2:000\n");
}

void loop(void)
{
    int i;
    for (i=0; i<25; i++)
    {
        SwChkInc();
        delay(10);
    }
    lcd_setCursor(0,1);
    printf("1:%03d 2:%03d\n",SwP1,SwP2);
}

int main(void)
{
    init();
    
    setup();
   
    for (;;)
        loop();

}