Ultrasonic Sensor HC-05 Sketch

This is the 4th phase in the making of our autonomous Biotronics Lego Walker. In  this phase a ultrasonic sensor HC05 is added on the robot's microcontroller. The Lawsin Linkage is also used in this experimental model.

This Biotronics project is made up of an Arduino Uno microcontroller, ultrasonic sensor HC-05 , an LED indicator, a piezo speaker, a microservo motor SG90 , a stepper motor 28BYJ-48, one power function, and LEGO's  bricks and pieces.

Phase 4: Ultrasonic Sensor Sketch

/////////////////////////////////////////////////////////////////////////////////
/*
Ultrasonic Sensor Test
This is the 4th phase of The Biotronics Lego Project.
This sketch test a sonic sensor on Arduino Uno.
The sensor will calculate distance
The sensor is attached to digital pins 11,12
Sketched by J.B.Wylzan
*/
#include <Servo.h>

 const int trigPin = 11;
 const int echoPin = 12;
int i;
int long duration;
int distance;

Servo myServo;
void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  Serial.begin(9600);
  myServo.attach(10);
}
void loop() {

  for(int i=15;i<=165;i++){ 
  myServo.write(i);
  delay(15);
  distance = calculateDistance();
 
  Serial.print(i);
 Serial.print(",");
 Serial.print(distance);
 Serial.print(".");
  }

  for(int i=165;i>15;i--){  
  myServo.write(i);
  delay(30);
  distance = calculateDistance();
  Serial.print(i);
  Serial.print(",");
  Serial.print(distance);
  Serial.print(".");
  }
}
 
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance= duration*0.034/2;
  return distance;
}

//////////////////////////////////////////////////////////////////////////////

*Biotronics are robots in forms of insects, animals, and plants that look alive or with life. The word was coined by Lawsin in his book Creation by Laws. In technical term, Biotronics is the science of robots with self consciousness. Bio means life and tronics means intelligent electronics(neurotronics).