[Voltar]

[Avançar]

// Projeto: Hand robot InMoov - movimenta um dedo da mão

 #include "Servo.h" 
 
 const int Pino_Servo1 = 5; 
 const int Pino_Resistivo1 = A0; 
 
 int Leitura_Resistivo1;  
 int Posicao_Servo1; 
 Servo Meu_Servo1; 
 
 void setup () { 
       Serial.begin (57600); 
       Meu_Servo1.write (30);  			// Mão fechada. 
       Posicao_Servo1 = 30; 
       Meu_Servo1.attach (Pino_Servo1); 
 } 
 
 void loop () { 
       Leitura_Resistivo1 = analogRead (Pino_Resistivo1); 
       Serial.print ("Analog reading = "); 
       Serial.print (Leitura_Resistivo1); 					// Leitura bruta
       
  // --------- limites estabelecidos da leitura -------- // 
       
       if (Leitura_Resistivo1 < 25) { 
       	    Serial.println (" - Sem pressao"); 
       } else if (Leitura_Resistivo1 < 30) { 
       		    Serial.println (" - Toque leve"); 
       } else if (Leitura_Resistivo1 < 50) { 
      		    Serial.println (" - Aperto leve"); 
       } else if (Leitura_Resistivo1 < 110) { 
       		    Serial.println (" - Aperto médio"); 
       } else if (Leitura_Resistivo1 < 200) { 
       		    Serial.println (" - Aperto forte"); 
       } 
       delay (1000); 
       
       AbreMao (Posicao_Servo1, 1); 
       delay (3000); 
     
       FechaMao (Posicao_Servo1, 1); 
       delay (3000); 
     
 } 
 
 void AbreMao (int posicao, int servo) { 
 
     for (; posicao < 130;  posicao ++) { 
          Meu_Servo1.write (posicao);    
          if (analogRead (Pino_Resistivo1) > 30) {  
              break; 
          }      
     } 
 } 
 
 void FechaMao () { 
 
     Meu_Servo1.write (30);  			 
     posicao = 30; 
}

[Voltar]

[Avançar]