Hallo allemaal ,
Ik ben bezig met een nieuw robot projectje , en ik gebruik nu voor de eerste keer ultrasone afstandssensoren.
Ik heb een aantal HC-SR04 sensoren.
Ik had een kleine test opstelling gemaakt met een Arduino. Maar nu doen de sensors raar.
Ik heb geprogrammeerd dat een led moet aangaan als een object dichter dan 10 cm komt.
Soms gaat die al aan bij bv 25cm , en daarna blijft het helemaal niet stabiel.
Als ik dan op pakweg 7 cm zit , begint de led als zot te knipperen.
Ook , komt er hoorbaar geluid uit de transducer , een hoge toon van ongeveer rond de 15kHz denk ik.
Dus dacht ik aan storingen op de voeding door de Arduino.
Maar na bijplaatsen van een elco en een ontstoringscondensator nog altijd geen verbetering.
Programma :
c code:
int ECHO_L_PIN = 2;
int TRIG_L_PIN = 3;
int ECHO_R_PIN = 4;
int TRIG_R_PIN = 5;
int LedLPin = 6;
int LedRPin = 7;
void setup(){
pinMode(ECHO_L_PIN, INPUT);
pinMode(ECHO_R_PIN, INPUT);
pinMode(LedLPin, OUTPUT);
pinMode(LedRPin, OUTPUT);
pinMode(TRIG_L_PIN, OUTPUT);
pinMode(TRIG_R_PIN, OUTPUT);
}
void loop(){
digitalWrite(TRIG_R_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_R_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_R_PIN, LOW);
int distance_R = pulseIn(ECHO_R_PIN, HIGH);
distance_R= distance_R/58; distance from time of pulse
delayMicroseconds(200);
if ((distance_R <= 10) && (distance_R > 0))
{
digitalWrite(LedRPin , HIGH);
digitalWrite(LedLPin , LOW);
}
else
{
digitalWrite(LedRPin , LOW);
digitalWrite(LedLPin , LOW);
}
}
Kan iemand mij hierme helpen?