#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