Zobrazují se příspěvky se štítkemdálkoměr. Zobrazit všechny příspěvky
Zobrazují se příspěvky se štítkemdálkoměr. Zobrazit všechny příspěvky

neděle 26. března 2017

Ultrazvukový senzor podruhé

Tentokrát s přerušením


#define ECHOPIN 2 // Echo pin z HC-SC04 na pin 2
#define TRIGPIN 10 // Trig pin z HC-SC04 na pin 5

float distance = 0.0;

static unsigned long startTime;
static unsigned long pulseWidth;

void EchoPinISR() 
{    
    if (digitalRead(2)) // Gone HIGH
        startTime = micros();
    else{  // Gone LOW
        pulseWidth = micros() - startTime;
        distance = pulseWidth * 0.017315f;
    }
}

void setup()
{
  //Nastaví sériovou komunikaci
  Serial.begin(9600);

  //Nastaví pin 2 jako vstupní
  pinMode(ECHOPIN, INPUT);
  attachInterrupt(digitalPinToInterrupt(ECHOPIN), EchoPinISR, CHANGE);

  //Nastaví pin 5 jako výstupní
  pinMode(TRIGPIN, OUTPUT);
}

void trig()
{
    // Vyšle impuls do modulu HC-SR04
    digitalWrite(TRIGPIN, LOW);
    delayMicroseconds(2);
    digitalWrite(TRIGPIN, HIGH);
    delayMicroseconds(10);
    digitalWrite(TRIGPIN, LOW);
}

  int lastPing=0;
  
void loop()
{
  if (lastPing+20 < millis())
  {
    lastPing = millis();
    trig();
  }
   

    //delay(12); // 4m čekání
    if (distance < 1000)
    {
      // odešle informace na sérivý port
      Serial.println(distance); // pro zobrazení na plotru
    }else
    {
      // ERROR
    }
    
}

Zdroj: 
http://forum.arduino.cc/index.php?topic=283086.0

čtvrtek 2. února 2017

9. Dálkoměr - HC-SR04

Měříme vzdálenost s HC-SR04


Tutorial:
http://howtomechatronics.com/tutorials/arduino/ultrasonic-sensor-hc-sr04/

Video:
https://www.youtube.com/watch?v=kQRYIH2HwfY

eBay - 30,-Kč
http://www.ebay.com/itm/121928420335?_trksid=p2057872.m2749.l2649&ssPageName=STRK%3AMEBIDX%3AIT


Poznámka:
Při testování na pinech 2 a 3 mi to nefungovalo (asi je na nich navěšena seriová linka), pro to jsem je posunul o dva piny vedle a hned se všechno rozjelo.

Kód:
#define ECHOPIN 4 // Echo pin z HC-SC04 na pin 4
#define TRIGPIN 5 // Trig pin z HC-SC04 na pin 5
void setup()
{
  //Nastaví sériovou komunikaci
  Serial.begin(9600);
  //Nastaví pin 4 jako vstupní
  pinMode(ECHOPIN, INPUT);
  //Nastaví pin 5 jako výstupní
  pinMode(TRIGPIN, OUTPUT);
}
void loop()
{
    // Vyšle impuls do modulu HC-SR04
    digitalWrite(TRIGPIN, LOW);
    delayMicroseconds(2);
    digitalWrite(TRIGPIN, HIGH);
    delayMicroseconds(10);
    digitalWrite(TRIGPIN, LOW);
 
    // Změří puls
    float distance = pulseIn(ECHOPIN, HIGH);
 
    // Spočítá vzdálenost
    distance= distance*0.017315f;
 
    // odešle informace na sérivý port
    Serial.println(distance); // pro zobrazení na plotru
    delay(50);
    Serial.print(distance); // Pro zobrazení na monitoru
    // Serial.print("cm\n");
    // počká 1 sekundu
    // delay(1000);
}