How to make Bluetooth controlled Tower Crane



 




Click here and download App 


           CODE 

/* if you have to make more 


 *  intresting projects like this then subscribe to my channel {Tech Technologh Pk}.


 */


char pn;




#include<AFMotor.h>


#include <Servo.h> // servo library




int l=200;


int pos = 0;


int x=0;


int y=0;




 AF_DCMotor motor1(1);


 AF_DCMotor motor2(2);



int mot_speed = l;


Servo myservo1, myservo2, myservo3;




void setup() {


  myservo1.attach(10); 


  myservo2.attach(9);


  myservo3.attach(11);

  


  myservo1.write(0);


  myservo1.write(0);


Serial.begin(9600);


}




void loop()


{


    motor1.setSpeed(mot_speed);


  motor2.setSpeed(mot_speed);



 while(Serial.available()>0)


 {


  pn=Serial.read();


  Serial.print(pn);


}


   if (pn == 'A')


    {


      motor1.run(FORWARD);


      motor2.run(FORWARD);


    }


     if (pn == 'B')


    {


      motor1.run(BACKWARD);


      motor2.run(BACKWARD);


    }


     if (pn == 'M')


    {


      motor1.run(FORWARD);


     motor2.run(BACKWARD);


    }


     if (pn == 'm')


    {


      motor2.run(FORWARD);


      motor1.run(BACKWARD);


     


    }


    

    if (pn == 'Z')


    {


      motor1.run(RELEASE);


      motor2.run(RELEASE);


      


    }


    if (pn == 'C')


    {


     for (pos = x; pos <= 180; pos += 1) { 


    myservo1.write(pos);             


    delay(30);


    x =x+1;


    break;


    pn = 0;


    }}


    if (pn == 'D')


    {


    for (pos = x; pos >= 0; pos -= 1) { 


    myservo1.write(pos);              


    delay(30);


    x =x-1;


    break;


     pn = 0;


    }}


    if (pn == 'c')


    {


       for (pos = y; pos <= 180; pos += 1) { 


    myservo2.write(pos);             


    delay(30);


    y =y+1;


    break;


     pn = 0;


    }}


    if (pn == 'd')


    {


    for (pos = y; pos >= 0; pos -= 1) { 


    myservo2.write(pos);              


    delay(30);


    y =y-1;


    break;


     pn = 0;


    }


    }

if (pn == 'X')


    {


     for (pos = x; pos <= 180; pos += 1) { 


    myservo3.write(pos);             


    delay(30);


    x =x+1;


    break;


    pn = 0;


    }}


if (pn == 'Y')


    {


    for (pos = x; pos >= 0; pos -= 1) { 


    myservo3.write(pos);              


    delay(30);


    x =x-1;


    break;


     pn = 0;


    }}

      if (pn == 'm')


    {


      l=50;


 


    }


      if (pn == 'n')


    {


    l=100;


 


    }


      if (pn == 'o')


    {


      l=150;


 


    }


      if (pn == 'p')


    {


      l=200;


 


    }


    if (pn == 'q')


    {


      l=255;


 


    }







        }   

Post a Comment

Previous Post Next Post

Contact Form