Scribd
Upload
35 views

UPDATED Arduino Code

This code defines constants for trigger and echo pins connected to two ultrasonic sensors. It initializes the sensor pins as inputs/outputs in setup(). The find_distance() function measures distance from each sensor and stores in distL and distR variables. The main loop continuously measures distances and prints them for debugging. It implements different control modes based on sensor distances, like play/pause if both near and lock left/right control if one hand is near for a period.

Uploaded by

After Specs
Copyright
© © All Rights Reserved
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
35 views

UPDATED Arduino Code

This code defines constants for trigger and echo pins connected to two ultrasonic sensors. It initializes the sensor pins as inputs/outputs in setup(). The find_distance() function measures distance from each sensor and stores in distL and distR variables. The main loop continuously measures distances and prints them for debugging. It implements different control modes based on sensor distances, like play/pause if both near and lock left/right control if one hand is near for a period.

Uploaded by

After Specs
Copyright
© © All Rights Reserved
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
You are on page 1/ 3

const int trigger1 = 1; //Trigger pin of 1st Sesnor

const int echo1 = 2; //Echo pin of 1st Sesnor


const int trigger2 = 3; //Trigger pin of 2nd Sesnor
const int echo2 = 4;//Echo pin of 2nd Sesnor

long time_taken;
int dist,distL,distR;

long duration;
float r;
unsigned long temp=0;
int temp1=0;
int l=0;
void find_distance (void);
void find_distance (void)
{
digitalWrite(trigger1, LOW);
delayMicroseconds(2);
digitalWrite(trigger1, HIGH);
delayMicroseconds(10);
digitalWrite(trigger1, LOW);
duration = pulseIn(echo1, HIGH, 5000);
r = 3.4 * duration / 2;
distL = r / 100.00;
digitalWrite(trigger2, LOW);
delayMicroseconds(2);
digitalWrite(trigger2, HIGH);
delayMicroseconds(10);
digitalWrite(trigger2, LOW);

duration = pulseIn(echo2, HIGH, 5000);


r = 3.4 * duration / 2;
distR = r / 100.00;
delay(100);
}

void setup() {
Serial.begin(9600);

pinMode(trigger1, OUTPUT);
pinMode(echo1, INPUT);
pinMode(trigger2, OUTPUT);
pinMode(echo2, INPUT);
}

/*###Function to calculate distance###*/


void calculate_distance(int trigger, int echo)
{
digitalWrite(trigger, LOW);
delayMicroseconds(2);
digitalWrite(trigger, HIGH);
delayMicroseconds(10);
digitalWrite(trigger, LOW);

time_taken = pulseIn(echo, HIGH);


dist= time_taken*0.034/2;
if (dist>50)
dist = 50;
}

void loop() { //infinite loopy


calculate_distance(trigger1,echo1);
distL =dist; //get distance of left sensor

calculate_distance(trigger2,echo2);
distR =dist; //get distance of right sensor

//Uncomment for debudding


/*Serial.print("L=");
Serial.println(distL);
Serial.print("R=");
Serial.println(distR);
*/

//Pause Modes -Hold


if ((distL >25 && distR>25) && (distL <50 && distR<50)) //Detect both hands
{Serial.println("Play/Pause"); delay (500);}

calculate_distance(trigger1,echo1);
distL =dist;

calculate_distance(trigger2,echo2);
distR =dist;

//Control Modes

//Lock Left - Control Mode


if (distL>=10 && distL<=20)
{
delay(50); //Hand Hold Time
calculate_distance(trigger1,echo1);
distL =dist;
if (distL>=10 && distL<=20)
{
Serial.println("Left Locked");
while(distL<=40)
{
calculate_distance(trigger1,echo1);
distL =dist;
if (distL<15) //Hand pushed in
{Serial.println ("Vup"); delay (300);}
if (distL>20) //Hand pulled out
{Serial.println ("Vdown"); delay (300);}
}
}
}
//Lock Right - Control Mode
if (distR>=10 && distR<=20)
{
delay(50); //Hand Hold Time
calculate_distance(trigger2,echo2);
distR =dist;
if (distR>=10 && distR<=20)
{
Serial.println("Right Locked");
while(distR<=40)
{
calculate_distance(trigger2,echo2);
distR =dist;
if (distR<15 ) //Right hand pushed in
{Serial.println ("Rewind"); delay (300);}
if (distR>20) //Right hand pulled out
{Serial.println ("Forward"); delay (300);}
}
}
}

//Swipe Next - Control Mode


if(distR<=8 && distR>=0)
{
temp=millis();
while(millis()<=(temp+300))
find_distance();

{
Serial.println("next");
}
}

delay(200);
}

You might also like