Caring Server: January 2016

Sunday, 3 January 2016

CODE FOR ULTRASONIC SENSOR

int trig=3;
int echo=2;
int led=9;

void setup()
{
Serial.begin(9600);
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
pinMode(led,OUTPUT);
}

void loop()
{
int duration;
int distance;
digitalWrite(trig,HIGH);
delay(1000);
digitalWrite(echo,LOW);
duration=pulseIn(echo,HIGH);
distance= (duration/2) /29.1;
Serial.print(distance);
Serial.print("cm\n");
delay(1000);
if (distance=13)
{
digitalWrite(led,HIGH);
}
}

CODE FOR LINE FOLLOWER IN ARDUINO

IR SENSOR [Click Here]
LINE FOLLOWER [Click Here]

#define lmotorf 8

#define lmotorb 9

#define rmotorf 10

#define rmotorb 11

void setup() {

pinMode(lmotorf,OUTPUT);

pinMode(lmotorb,OUTPUT);

pinMode(rmotorf,OUTPUT);

pinMode(rmotorb,OUTPUT);

pinMode(6,INPUT);

pinMode(7,INPUT);

}

void loop() {

int lsensor=digitalRead(6);

int rsensor=digitalRead(7);

if((lsensor==LOW)&&(rsensor==LOW))

{

digitalWrite(lmotorf,HIGH);

digitalWrite(rmotorf,LOW);

digitalWrite(lmotorb,LOW);

digitalWrite(rmotorb,LOW);

}

else if((lsensor==HIGH)&&(rsensor==LOW))

{

digitalWrite(lmotorf,LOW);

digitalWrite(rmotorf,HIGH);

digitalWrite(lmotorb,HIGH);

digitalWrite(rmotorb,LOW);

}

else if((lsensor==LOW)&&(rsensor==HIGH))

{

digitalWrite(lmotorf,HIGH);

digitalWrite(rmotorf,LOW);

digitalWrite(lmotorb,LOW);

digitalWrite(rmotorb,HIGH);

}

else

{

digitalWrite(lmotorf,LOW);

digitalWrite(rmotorf,LOW);

digitalWrite(lmotorb,LOW);

digitalWrite(rmotorb,LOW);

}

CODE For H-Bridge Shield


#define ENA 5;

#define ENB 3;

#define IN1 2;

#define IN2 4;

#define IN3 6;

#define IN4 7;



void setup() {

 pinMode(ENA,OUTPUT);

pinMode(ENB,OUTPUT);

pinMode(IN1,OUTPUT);

pinMode(IN2,OUTPUT);

pinMode(IN3,OUTPUT);

pinMode(IN4,OUTPUT);

}



void loop()

{

motorA(1,15);

delay(5000);

motorA(3,100);

motorB(1,15);

delay(5000);

motorB(3,50);

motorA(0,100);

delay(5000);



}

void motorA(int mode,int percent)

{

  int duty=map(percent,0,100,0,255);

  switch(mode)

  {

    case 0:

    digitalWrite(ENA,LOW);

    break;

   

    case 1:

    digitalWrite(IN1,HIGH);

    digitalWrite(IN2,LOW);

    analogWrite(ENA,duty);

    break;

   

    case 2:

    digitalWrite(IN1,LOW);

    digitalWrite(IN2,HIGH);

    analogWrite(ENA,duty);

    break;

   

    case 3:

    digitalWrite(IN1,LOW);

    digitalWrite(IN2,LOW);

    analogWrite(ENA,duty);

    break;

  }

}





void motorB(int mode,int percent)

{

  int duty=map(percent,0,100,0,255);

  switch(mode)

  {

    case 0:

    digitalWrite(ENB,LOW);

    break;

   

    case 1:

    digitalWrite(IN3,HIGH);

    digitalWrite(IN4,LOW);

    analogWrite(ENB,duty);

    break;

   

    case 2:

    digitalWrite(IN3,LOW);

    digitalWrite(IN4,HIGH);

    analogWrite(ENB,duty);

    break;

   

    case 3:

    digitalWrite(IN3,LOW);

    digitalWrite(IN4,LOW);

    analogWrite(ENB,duty);

    break;

  }

}


// Use this code to test your motor with the Arduino board:



// if you need PWM, just use the PWM outputs on the Arduino

// and instead of digitalWrite, you should use the analogWrite command



// --------------------------------------------------------------------------- Motors

int motor_left[] = {3,8};

int motor_right[] = {12, 7};



// --------------------------------------------------------------------------- Setup

void setup() {

Serial.begin(9600);



// Setup motors

int i;

for(i = 0; i < 2; i++){

pinMode(motor_left[i], OUTPUT);

pinMode(motor_right[i], OUTPUT);

}



}



// --------------------------------------------------------------------------- Loop

void loop() {



drive_forward();

delay(1000);

motor_stop();

Serial.println("1");



drive_backward();

delay(1000);

motor_stop();

Serial.println("2");



turn_left();

delay(1000);

motor_stop();

Serial.println("3");



turn_right();

delay(1000);

motor_stop();

Serial.println("4");



motor_stop();

delay(1000);

motor_stop();

Serial.println("5");

}



// --------------------------------------------------------------------------- Drive



void motor_stop(){

digitalWrite(motor_left[0], LOW);

digitalWrite(motor_left[1], LOW);



digitalWrite(motor_right[0], LOW);

digitalWrite(motor_right[1], LOW);

delay(25);

}



void drive_forward(){

digitalWrite(motor_left[0], HIGH);

digitalWrite(motor_left[1], LOW);



digitalWrite(motor_right[0], HIGH);

digitalWrite(motor_right[1], LOW);

}



void drive_backward(){

digitalWrite(motor_left[0], LOW);

digitalWrite(motor_left[1], HIGH);



digitalWrite(motor_right[0], LOW);

digitalWrite(motor_right[1], HIGH);

}



void turn_left(){

digitalWrite(motor_left[0], LOW);

digitalWrite(motor_left[1], HIGH);



digitalWrite(motor_right[0], HIGH);

digitalWrite(motor_right[1], LOW);

}



void turn_right(){

digitalWrite(motor_left[0], HIGH);

digitalWrite(motor_left[1], LOW);



digitalWrite(motor_right[0], LOW);

digitalWrite(motor_right[1], HIGH);

}

L293D CODE

// Use this code to test your motor with the Arduino board:

// if you need PWM, just use the PWM outputs on the Arduino
// and instead of digitalWrite, you should use the analogWrite command

// --------------------------------------------------------------------------- Motors
int motor_left[] = {3,8};
int motor_right[] = {12, 7};

// --------------------------------------------------------------------------- Setup
void setup() {
Serial.begin(9600);

// Setup motors
int i;
for(i = 0; i < 2; i++){
pinMode(motor_left[i], OUTPUT);
pinMode(motor_right[i], OUTPUT);
}

}

// --------------------------------------------------------------------------- Loop
void loop() {

drive_forward();
delay(1000);
motor_stop();
Serial.println("1");

drive_backward();
delay(1000);
motor_stop();
Serial.println("2");

turn_left();
delay(1000);
motor_stop();
Serial.println("3");

turn_right();
delay(1000);
motor_stop();
Serial.println("4");

motor_stop();
delay(1000);
motor_stop();
Serial.println("5");
}

// --------------------------------------------------------------------------- Drive

void motor_stop(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], LOW);
delay(25);
}

void drive_forward(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}

void drive_backward(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], HIGH);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], HIGH);
}

void turn_left(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], HIGH);

digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}

void turn_right(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], HIGH);
}

------------------------------------------------------------------------------------------
IRRELEVANT

Beside this code u can also take help

// Use this code to test your motor with the Arduino board:

// if you need PWM, just use the PWM outputs on the Arduino
// and instead of digitalWrite, you should use the analogWrite command

// --------------------------------------------------------------------------- Motors
int motor_left[] = {2, 3};
int motor_right[] = {7, 8};

// --------------------------------------------------------------------------- Setup
void setup() {
Serial.begin(9600);

// Setup motors
int i;
for(i = 0; i < 2; i++){
pinMode(motor_left[i], OUTPUT);
pinMode(motor_right[i], OUTPUT);
}

}

// --------------------------------------------------------------------------- Loop
void loop() {

drive_forward();
delay(1000);
motor_stop();
Serial.println("1");

drive_backward();
delay(1000);
motor_stop();
Serial.println("2");

turn_left();
delay(1000);
motor_stop();
Serial.println("3");

turn_right();
delay(1000);
motor_stop();
Serial.println("4");

motor_stop();
delay(1000);
motor_stop();
Serial.println("5");
}

// --------------------------------------------------------------------------- Drive

void motor_stop(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], LOW);
delay(25);
}

void drive_forward(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}

void drive_backward(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], HIGH);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], HIGH);
}

void turn_left(){
digitalWrite(motor_left[0], LOW);
digitalWrite(motor_left[1], HIGH);

digitalWrite(motor_right[0], HIGH);
digitalWrite(motor_right[1], LOW);
}

void turn_right(){
digitalWrite(motor_left[0], HIGH);
digitalWrite(motor_left[1], LOW);

digitalWrite(motor_right[0], LOW);
digitalWrite(motor_right[1], HIGH);
}

For IR sensor

int analogPin = 3;     // Infrared Sensor (Right lead) connected to analog pin 3
// outside leads to ground and +5V
int val = 0; // variable to store the value read

void setup()
{
Serial.begin(9600);          // setup serial
}

void loop()
{
val = analogRead(analogPin);    // read the input pin
Serial.println(val); // debug value
}

Program for Forward motion when Infra Red Sensor Value is smaller than 100

// This is the basic code which runs a loop that makes the Robot go straight forward when the Infrared value is below 100.

int analogPin = 3;     // Infrared Sensor (Right lead) connected to analog pin 3
// Infrared Sensor(middle Lead) connected to +5V
// Infrared Sensor(Left Lead) connected to ground

int val = 0;           // variable to store the value read

int LeftMotorForward = 10; // Pin 10 has Left Motor connected on Arduino boards.
int LeftMotorReverse = 9; // Pin 9 has Left Motor connected on Arduino boards.

int RightMotorForward = 12; // Pin 12 has Right Motor connected on Arduino boards.
int RightMotorReverse = 13; // Pin 13 has Right Motor connected on Arduino boards.

//------------------------------------------------------------------------------------------------

void setup()
{
pinMode(LeftMotorForward, OUTPUT); // initialize the pin as an output.
pinMode(RightMotorForward, OUTPUT); // initialize the pin as an output.
pinMode(LeftMotorReverse, OUTPUT); // initialize the pin as an output.
pinMode(RightMotorReverse, OUTPUT); // initialize the pin as an output.

   Serial.begin(9600);          // setup serial
}

// The following Loop is to make the Robot go staright when the Infrared value is below 100

void loop()

{
   val = analogRead(analogPin);    // read the input pin
Serial.println(val);             // debug value

if (val <100)

// If the read value is < 100 then run the code below which will turn both Left and Right Motor on making the Robot go straight.

{
   digitalWrite(RightMotorForward, HIGH);   // turn the Right Motor ON
   digitalWrite(LeftMotorForward, HIGH);   // turn the Left Motor ON
   delay(10000);               // wait for 10 seconds

   digitalWrite(RightMotorForward,LOW);   // turn the Right Motor OFF
   digitalWrite(LeftMotorForward, LOW);   // turn the Left Motor OFF
   delay(10000);               // wait for 10 seconds
}

}

program when Infrared Red sensor Value is smaller than 100

When IR Value is Less than 100 then the Motors are turned on and the Robot drives forward for 10 seconds.

Ada Fruit Code


// Adafruit Motor shield library

// copyright Adafruit Industries LLC, 2009

// this code is public domain, enjoy!



#include <AFMotor.h>



AF_DCMotor motor(4);



void setup() {

  Serial.begin(9600);           // set up Serial library at 9600 bps

  Serial.println("Motor test!");



  // turn on motor

  motor.setSpeed(200);



  motor.run(RELEASE);

}



void loop() {

  uint8_t i;

 

  Serial.print("tick");

 

  motor.run(FORWARD);

  for (i=0; i<255; i++) {

    motor.setSpeed(i); 

    delay(10);

 }



  for (i=255; i!=0; i--) {

    motor.setSpeed(i); 

    delay(10);

 }

 

  Serial.print("tock");



  motor.run(BACKWARD);

  for (i=0; i<255; i++) {

    motor.setSpeed(i); 

    delay(10);

 }



  for (i=255; i!=0; i--) {

    motor.setSpeed(i); 

    delay(10);

 }

 



  Serial.print("tech");

  motor.run(RELEASE);

  delay(1000);

}