Sketch Due Motori Ir Sensor Ino
3
//Controllo 2 motori e sesnore ir Sharp....Bart #include<DistanceGP2Y0A21YK.h> // Variabile dist per sensore sharp DistanceGP2Y0A21YK Dist; int distance; #define SENSOR_TRIG_PIN 7 #define SENSOR_ECHO_PIN 6 #define SENSOR_MIN_DIST 10 #define SENSOR_MAX_DIST 200 #define MOTOR_CH_A 12 #define BRAKE_CH_A 9 #define SPEED_CH_A 3 #define MOTOR_CH_B 13 #define BRAKE_CH_B 8 #define SPEED_CH_B 11 #define HI_SPEED 175 #define LO_SPEED 75 void setup () { Serial .begin (9600); Dist.begin (A5); pinMode (MOTOR_CH_A, OUTPUT ); pinMode (BRAKE_CH_A, OUTPUT ); pinMode (SPEED_CH_A, OUTPUT ); pinMode (MOTOR_CH_B, OUTPUT ); pinMode (BRAKE_CH_B, OUTPUT ); pinMode (SPEED_CH_B, OUTPUT ); } void loop () { delay (50); distance = Dist.getDistanceCentimeter(); Serial .print ("\nDistance in centimers: "); Serial .print (distance); delay (500); //make it readable int distance = Dist.getDistanceCentimeter(); Serial .println (distance);
description
Sketch Arduino IR Sensor
Transcript of Sketch Due Motori Ir Sensor Ino
-
//Controllo 2 motori e sesnore ir Sharp....Bart
#include
// Variabile dist per sensore sharpDistanceGP2Y0A21YK Dist;int distance;
#define SENSOR_TRIG_PIN 7#define SENSOR_ECHO_PIN 6#define SENSOR_MIN_DIST 10#define SENSOR_MAX_DIST 200
#define MOTOR_CH_A 12#define BRAKE_CH_A 9#define SPEED_CH_A 3
#define MOTOR_CH_B 13#define BRAKE_CH_B 8#define SPEED_CH_B 11
#define HI_SPEED 175#define LO_SPEED 75
void setup() { Serial.begin(9600); Dist.begin(A5);
pinMode(MOTOR_CH_A, OUTPUT); pinMode(BRAKE_CH_A, OUTPUT); pinMode(SPEED_CH_A, OUTPUT);
pinMode(MOTOR_CH_B, OUTPUT); pinMode(BRAKE_CH_B, OUTPUT); pinMode(SPEED_CH_B, OUTPUT);}
void loop() { delay(50); distance = Dist.getDistanceCentimeter(); Serial.print("\nDistance in centimers: "); Serial.print(distance); delay(500); //make it readable
int distance = Dist.getDistanceCentimeter(); Serial.println(distance);
-
go_forward(); if ( distance
-
analogWrite(SPEED_CH_B, HI_SPEED);}
void turn_right() { Serial.println("Going right...");
digitalWrite(MOTOR_CH_A, HIGH); digitalWrite(BRAKE_CH_A, LOW); analogWrite(SPEED_CH_A, HI_SPEED);
digitalWrite(MOTOR_CH_B, LOW); digitalWrite(BRAKE_CH_B, HIGH); analogWrite(SPEED_CH_B, LO_SPEED);}
void brake() { Serial.println("Braking...");
digitalWrite(BRAKE_CH_A, HIGH); digitalWrite(BRAKE_CH_B, HIGH);}
