Rabu, 08 Juni 2016

robot mobil

#define a1 6  //motor 1
#define a2 7
#define b1 8  // motor 2
#define b2 9
int kond = 5; int bt=5; int b=255;
int a=255; int c=255; int d=255; int x=255;
void setup()
{
  Serial.begin( 9600 );
  pinMode( a1, OUTPUT );
  pinMode( a2, OUTPUT );
  pinMode( b1, OUTPUT );
  pinMode( b2, OUTPUT );
}

void loop()
{
//mundur
  analogWrite( a1, 222 ); analogWrite( a2, 0 );
  analogWrite( b1, 0 ); analogWrite( b2, 0 );

// maju
  delay(2133);
  analogWrite( a1, 0 ); analogWrite( a2, 222 );
  analogWrite( b1, 0 ); analogWrite( b2, 0 );


  delay(2133);
  analogWrite( a1, 0 ); analogWrite( a2, 0 );
  analogWrite( b1, 222 ); analogWrite( b2, 0 );


  delay(2133);
  analogWrite( a1, 0 ); analogWrite( a2, 0 );
  analogWrite( b1, 0 ); analogWrite( b2, 222 );


  delay(2133);
  analogWrite( a1, 0 ); analogWrite( a2, 0 );
  analogWrite( b1, 0 ); analogWrite( b2, 0 );


  delay(2133);
}



Puasa hari ke empat. 9 Juni 2016. Hari kamis yang cerah. Saatnya mulai percobaan untuk membuat robot yang dapat dikendalikan melalui  bluetooth dengan ponsel android sebagai pengendali.
percobaan 1 maju mundur cantik

#define a1 10 // D10 --> Motor B Input A --> MOTOR B +
#define a2 11 // D11 --> Motor B Input B --> MOTOR B -
#define b1 8 // D10 --> Motor B Input A --> MOTOR B +
#define b2 9 // D11 --> Motor B Input B --> MOTOR B -
int kond = 5; int bt=5;
void setup()
{
  Serial.begin( 9600 );
  pinMode( a1, OUTPUT );
  pinMode( a2, OUTPUT );
  pinMode( b1, OUTPUT );
  pinMode( b2, OUTPUT );
}

void loop()
{
if( Serial.available() >0 ) {
  bt= Serial.read (); }
if ( bt==1 ){
  if (kond=2){
  digitalWrite( a2, 0 ); digitalWrite( b2, 0 );
  delay(55); kond = 1;}
  digitalWrite( a1, 1 ); digitalWrite( a2, 0 );
  digitalWrite( b1, 1 ); digitalWrite( b2, 0 );
  delay(200);
}

if ( bt==2 ){
  if (kond=1){
  digitalWrite( a1, 0 ); digitalWrite( b1, 0 );
  delay(55);kond=2; }
  digitalWrite( a1, 0 ); digitalWrite( a2, 1);
  digitalWrite( b1, 0 ); digitalWrite( b2, 1);
  delay(200);
}
if ( bt==5 ){
  digitalWrite( a1, 0 ); digitalWrite( a2, 0 );
  digitalWrite( b1, 0 ); digitalWrite( b2, 0);
  delay(200);
}
delay(333);
}



belum di coba
program komplit

#define a1 10 // D10 --> Motor B Input A --> MOTOR B +
#define a2 11 // D11 --> Motor B Input B --> MOTOR B -
#define b1 8 // D10 --> Motor B Input A --> MOTOR B +
#define b2 9 // D11 --> Motor B Input B --> MOTOR B -
int kond = 5; int bt=5; int b=255;
int a=255; int c=255; int d=255; int x=255;
void setup()
{
  Serial.begin( 9600 );
  pinMode( a1, OUTPUT );
  pinMode( a2, OUTPUT );
  pinMode( b1, OUTPUT );
  pinMode( b2, OUTPUT );
}

void loop()
{
if( Serial.available() >0 ) {
  bt= Serial.read (); 
  }
  if (bt==6) x=255; //cepat
  if (bt==7) x=170; // Sedang
  if (bt==8) x=122; 
if ( bt==1 ){ // Maju
  if (kond==2){
  a=0; b=0; c=0; d= 0;
  delay(115); kond = 1;}
  a=x; b=0; c=x; d= 0;
  delay(200);
}

if ( bt==2 ){
  if (kond==1){
  a=0; b=0; c=0; d= 0;
  delay(115);kond=2; }
  a=0; b=x; c=0; d= x;
  delay(200);
}
if ( bt==5 ){
  a=0; b=0; c=0; d= 0;
  delay(200); kond=5;
}

if ( bt==4){ //belok kiri
  if (kond==1 ){
  a=100; b=0; c=255; d= 0; }
  if (kond==2 ){
  a=0; b=100; c=255; d= 0; }
  if (kond==5 ){
  a=0; b=0; c=255; d= 0; }
  delay(55);kond=4; }
if ( bt==3){ //belok kanan
  if (kond==1 ){
  a=255; b=0; c=111; d= 0; }
  if (kond==2 ){
  a=0; b=255; c=0; d= 110; }
  if (kond==5 ){
  a=255; b=0; c=0; d= 0; }
  delay(55);kond=3; }

  analogWrite( a1, a ); analogWrite( a2, b );
  analogWrite( b1, c ); analogWrite( b2, d );


  delay(133);
}




masuk line followr

#define a1 10 // D10 --> Motor B Input A --> MOTOR B +
#define a2 11 // D11 --> Motor B Input B --> MOTOR B -
#define b1 8 // D10 --> Motor B Input A --> MOTOR B +
#define b2 9 // D11 --> Motor B Input B --> MOTOR B -
int kond = 5; int bt=5; int b=255;
int a=255; int c=255; int d=255; int x=255;
int s1,s2;
void setup()
{
  Serial.begin( 9600 );
  pinMode( a1, OUTPUT );
  pinMode( a2, OUTPUT );
  pinMode( b1, OUTPUT );
  pinMode( b2, OUTPUT );
}

void loop()
{
if( Serial.available() >0 ) {
  bt= Serial.read (); 
  }
  if (bt !=9) { // Jalan Manual
  
  if (bt==6) x=255; //cepat
  if (bt==7) x=170; // Sedang
  if (bt==8) x=122; 
if ( bt==1 ){ // Maju
  if (kond==2){
  a=0; b=0; c=0; d= 0;
  delay(115); kond = 1;}
  a=x; b=0; c=x; d= 0;
  delay(200);
}

if ( bt==2 ){
  if (kond==1){
  a=0; b=0; c=0; d= 0;
  delay(115);kond=2; }
  a=0; b=x; c=0; d= x;
  delay(200);
}
if ( bt==5 ){
  a=0; b=0; c=0; d= 0;
  delay(200); kond=5;
}

if ( bt==4){ //belok kiri
  if (kond==1 ){
  a=100; b=0; c=255; d= 0; }
  if (kond==2 ){
  a=0; b=100; c=255; d= 0; }
  if (kond==5 ){
  a=0; b=0; c=255; d= 0; }
  delay(55);kond=4; }
if ( bt==3){ //belok kanan
  if (kond==1 ){
  a=255; b=0; c=111; d= 0; }
  if (kond==2 ){
  a=0; b=255; c=0; d= 110; }
  if (kond==5 ){
  a=255; b=0; c=0; d= 0; }
  delay(55);kond=3; }

  analogWrite( a1, a ); analogWrite( a2, b );
  analogWrite( b1, c ); analogWrite( b2, d );
  delay(133); } // Akhir Jalan Manual
  
  if (bt==9 ) {
    s1= analogRead (A0); s2= analogRead (A1);
 // s1 kiri  s2 kanan
  if (s1<111 && s2<111 } // maju
  if (s1<111 && s2>811 } // Kanan
  if (s1>811 && s2<111 } // Kiri
  if (s1>811 && s2>811 } // stop

}}







Tidak ada komentar:

Posting Komentar