2017年5月4日木曜日

いやいや


const int deg0msec = 600; // msec.
const int deg180msec = 2350; // msec.
int microSec = deg0msec;

void setup() {
    pinMode( 2, OUTPUT );
    pinMode(4,INPUT) ;
    Serial.begin( 9600 );
}

void loop() {
  int i;
   
    if (digitalRead(4) == LOW) {
      for(i=0;i<2;i++){
        microSec = deg0msec + 80 / 180.0 * ( deg180msec - deg0msec );
        if ( microSec >= deg0msec ) {
          digitalWrite( 2, HIGH );
          delayMicroseconds( microSec ); // ON
          digitalWrite( 2, LOW );
          delayMicroseconds( 10000 ); // OFF
          delayMicroseconds( 10000 - microSec ); // OFF40
       }
       delay(500);
       microSec = deg0msec + 0 / 180.0 * ( deg180msec - deg0msec );
        if ( microSec >= deg0msec ) {
          digitalWrite( 2, HIGH );
          delayMicroseconds( microSec ); // ON
          digitalWrite( 2, LOW );
          delayMicroseconds( 10000 ); // OFF
          delayMicroseconds( 10000 - microSec ); // OFF40
       }
       delay(500);
      }
    }
     if (digitalRead(4) == HIGH) {
      microSec = deg0msec + 30 / 180.0 * ( deg180msec - deg0msec );
        if ( microSec >= deg0msec ) {
          digitalWrite( 2, HIGH );
          delayMicroseconds( microSec ); // ON
          digitalWrite( 2, LOW );
          delayMicroseconds( 10000 ); // OFF
          delayMicroseconds( 10000 - microSec ); // OFF40
       }
     }

}

int serialReadAsInt() {
    char c[ 9 ] = "0";
    for ( int i = 0; i < 8; i++ ) {
        c[ i ] = Serial.read();
        if ( c[ i ] == '\0' )
            break;
    }
    return atoi( c );
}

0 件のコメント:

コメントを投稿