diff --git a/autonomousCar/driver.ino b/autonomousCar/driver.ino deleted file mode 100644 index 905b9ed..0000000 --- a/autonomousCar/driver.ino +++ /dev/null @@ -1,179 +0,0 @@ -/* -* Athors: Oulis Evnagelos, Oulis Nikolaos, Katsibras Drosos -* Ultrasonic Sensor HC-SR04 and Arduino -* Dual Stepper Motor Shiled 1.1 -* -*/ - -/* - * Include all libraries. -*/ -#include - -/* - * ------------------------------------------------------- -*/ - -/* - * All Definitions. -*/ -#define STEPS 2048 - -/* - * ------------------------------------------------------- -*/ - -// defines pins numbers -const int trigPin = 12; -const int echoPin = 9; -//const int response = 13; -/* - * For Motor Driver Pis. -*/ -const int in1 = 2; -const int in2 = 4; -const int in3 = 7; -const int in4 = 8; -const int rightSpeed = 5; -const int leftSpeed = 3; - -/* - * For Stepper Motor Pins -*/ -const int in1_1 = 6; -const int int2_1 = 10; -const int int3_1 = 11; -const int int4_1 = 13; - -// defines variables -long duration; -int distance, distanceCm; -int i; -/* - * -*/ -Stepper stepper(STEPS, in1_1, int2_1, int3_1, int4_1); - -void clearUltrasonic(){ - // Clears the trigPin - analogWrite(trigPin, LOW); - delayMicroseconds(2); -} - -void setup() { -pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output -pinMode(echoPin, INPUT); // Sets the echoPin as an Input - -//pinMode(response, OUTPUT); // Sets to led aoutput. - -pinMode(in1, OUTPUT); //Motor Driver 1st Pin -pinMode(in2, OUTPUT); //Motor Driver 2nd Pin -pinMode(in3, OUTPUT); //Motor Driver 3rd Pin -pinMode(in4, OUTPUT); //Motor Driver 4th Pin - -pinMode(rightSpeed, OUTPUT); -pinMode(leftSpeed, OUTPUT); - -stepper.setSpeed(200); - -Serial.begin(9600); // Starts the serial communication -clearUltrasonic(); -i = 0; -} - -int getDistance(int echoPin, int trigPin){ - clearUltrasonic(); - // Sets the trigPin on HIGH state for 10 micro seconds - digitalWrite(trigPin, HIGH); - delayMicroseconds(10); - digitalWrite(trigPin, LOW); - - // Reads the echbackwardoPin, returns the sound wave travel time in microseconds - duration = pulseIn(echoPin, HIGH); - distanceCm = duration * 0.0340 / 2; - - return distanceCm; -} - -//Stepper Function -void step(/*boolean dir,*/int steps){ -// digitalWrite(dirPin1,dir); -// digitalWrite(dirPin2,dir); - delay(50); - for(int i=0;i