/*
Módulo / Arduino
X / Pino A0
Y / Pino A1
Z / Pino A2
3.3v / 3.3v
GND / GND
SL / 3.3v
GS / GND
*/
int xp;
int yp;
int zp;
void setup()
{
pinMode(13,OUTPUT); //esq
pinMode(12,OUTPUT); //cima
pinMode(11,OUTPUT); //baixo
pinMode(10,OUTPUT); //dir
pinMode(9,OUTPUT); //G
pinMode(8,OUTPUT); //Alinhado
Serial.begin(9600);
}
void loop()
{
Serial.print("X: ");
xp=analogRead(A0);
Serial.print(xp);
Serial.print("Y: ");
yp=analogRead(A1);
Serial.print(yp);
Serial.print("Z: ");
zp=analogRead(A2);
Serial.println(zp);
if (xp > 330){ // cima
digitalWrite(12,HIGH);
digitalWrite(11,LOW);
}else if (xp < 320) {
digitalWrite(11,HIGH);
digitalWrite(12,LOW);
}else {
digitalWrite(11,LOW);
digitalWrite(12,LOW);
}
if (yp > 345){ // direita
digitalWrite(10,HIGH);
digitalWrite(13,LOW);
}else if (yp < 325){
digitalWrite(10,LOW);
digitalWrite(13,HIGH);
}else {
digitalWrite(10,LOW);
digitalWrite(13,LOW);
}
if (zp > 220){ // gravidade
digitalWrite(9,HIGH);
}else {
digitalWrite(9,LOW);
}
if (zp < 220 && (yp<335 amp="" yp="">325) && (xp<330 amp="" xp="">320) ){ // estabilizacao330>335>
digitalWrite(9,LOW);
digitalWrite(10,LOW);
digitalWrite(11,LOW);
digitalWrite(12,LOW);
digitalWrite(13,LOW);
digitalWrite(8,HIGH);
}else {
digitalWrite(8,LOW);
}
}
Nenhum comentário:
Postar um comentário