Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <SoftwareSerial.h>
- #include <Servo.h>
- Servo myservo1, myservo2, myservo3, myservo4;
- int bluetoothTx = 0;
- int bluetoothRx = 1;
- SoftwareSerial bluetooth(bluetoothTx, bluetoothRx);
- char Kierunek = 0;
- void setup()
- {
- myservo1.attach(3);
- myservo2.attach(5);
- myservo3.attach(6);
- myservo4.attach(9);
- pinMode(2, OUTPUT);
- pinMode(4, OUTPUT);
- pinMode(7, OUTPUT);
- pinMode(8, OUTPUT);
- pinMode(10, OUTPUT);
- pinMode(11, OUTPUT);
- digitalWrite(10,255);
- digitalWrite(11,255);
- Serial.begin(9600);
- bluetooth.begin(9600);
- }
- void loop()
- {
- if(Serial.available() > 0)
- {
- Kierunek = Serial.read();
- Serial.print(Kierunek);
- Serial.print("\n");
- if(Kierunek == '1')
- {
- digitalWrite(2, HIGH);
- digitalWrite(4, LOW);
- digitalWrite(7, HIGH);
- digitalWrite(8, LOW);
- delay(100);
- }
- if(Kierunek == '2')
- {
- digitalWrite(2, LOW);
- digitalWrite(4, HIGH);
- digitalWrite(7, LOW);
- digitalWrite(8, HIGH);
- delay(100);
- }
- if(Kierunek == '3')
- {
- digitalWrite(2, LOW);
- digitalWrite(4, HIGH);
- digitalWrite(7, HIGH);
- digitalWrite(8, LOW);
- delay(100);
- }
- }
- if(Kierunek == '4')
- {
- digitalWrite(2, HIGH);
- digitalWrite(4, LOW);
- digitalWrite(7, LOW);
- digitalWrite(8, HIGH);
- delay(100);
- }
- if(Kierunek == '5')
- {
- digitalWrite(2, LOW);
- digitalWrite(4, LOW);
- digitalWrite(7, LOW);
- digitalWrite(8, LOW);
- delay(100);
- }
- if(bluetooth.available()>= 5 )
- {
- unsigned int servopos = bluetooth.read();
- unsigned int servopos1 = bluetooth.read();
- unsigned int realservo = (servopos1 *256) + servopos;
- Serial.println(realservo);
- if (realservo >= 1000 && realservo <1180) {
- int servo1 = realservo;
- servo1 = map(servo1, 1000, 1180, 6, 180);
- myservo1.write(servo1);
- delay(10);
- }
- if (realservo >= 2000 && realservo <2180) {
- int servo2 = realservo;
- servo2 = map(servo2, 2000, 2180, 6, 180);
- myservo2.write(servo2);
- delay(10);
- }
- if (realservo >= 3000 && realservo <3180) {
- int servo3 = realservo;
- servo3 = map(servo3, 3000, 3180, 6, 180);
- myservo3.write(servo3);
- delay(10);
- }
- if (realservo >= 4000 && realservo <4180) {
- int servo4 = realservo;
- servo4 = map(servo4, 4000, 4180, 6, 180);
- myservo4.write(servo4);
- delay(10);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement