Traduzir/Translate/Traducir

quarta-feira, 7 de setembro de 2011

Código 1 de Leitura da Trena Digital com Arduino

Boa galera, aqui segue o primeiro código paraleitura do ci da trena. Funcionou mais ou menos como o esperado, mas ainda precisa de implementação.

int val=0;
int altura=200;


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

void loop() {
 
  if(digitalRead(3)==HIGH){
    
    val=1;
   } 
 
  if(val==1 && digitalRead(4)==HIGH && digitalRead(3)== LOW){
  val=2;
  }
 
  if(val==2 && digitalRead(4)==LOW && digitalRead(3)==LOW && digitalRead(2)==HIGH && altura<200){
  digitalWrite(13,HIGH);// desce nivel
  delay(300);
  digitalWrite(13,LOW);
  altura++;
  Serial.println("nivel desce");
  Serial.println(altura);
  Serial.println();
  val=0;
  } 
 
  if(val==1 && digitalRead(2)==HIGH && digitalRead(3)== LOW){
  val=3 ;
  }
 
  if(val==3 && digitalRead(2)==LOW && digitalRead(3)==LOW && digitalRead(4)==HIGH && altura>0){
  digitalWrite(12,HIGH);// sobe nivel
  delay(300);
  digitalWrite(12,LOW);
  altura--;
  Serial.println("nivel sobe");
  Serial.println(altura);
  Serial.println();
  val=0;
  } 
 
}

0 comentários:

Postar um comentário

Twitter Delicious Facebook Digg Stumbleupon Favorites More