Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- Servo bjservo;
- Servo bjservo2;
- Servo mjservo;
- Servo tjservo;
- Servo gripservo;
- int bjval = 0;
- int mjval = 0;
- int tjval = 179;
- int gripval = 179;
- const unsigned int BAUD_RATE = 9600;
- char w = 0;
- void setup()
- {
- bjservo.attach(7);
- bjservo2.attach(6);
- mjservo.attach(5);
- tjservo.attach(4);
- gripservo.attach(3);
- bjservo.write(bjval);
- bjservo2.write(179-bjval);
- mjservo.write(mjval);
- tjservo.write(tjval);
- gripservo.write(gripval);
- Serial.begin(9600);
- }
- void loop()
- {
- if (Serial.available()) {
- w = Serial.read();
- if (w == 'w'||w == 'W')
- {
- (bjval=bjval-1);
- bjservo.write(bjval);
- bjservo2.write(179-bjval);
- delay(15);
- }
- else if (w == 's'||w == 'S')
- {
- (bjval=bjval+1);
- bjservo.write(bjval);
- bjservo2.write(179-bjval);
- delay(15);
- }
- else if (w == 'a'||w == 'A')
- {
- (mjval=mjval-1);
- mjservo.write(mjval);
- delay(15);
- }
- else if (w == 'd'||w == 'D')
- {
- (mjval=mjval+1);
- mjservo.write(mjval);
- delay(15);
- }
- else if (w == 'k'||w == 'K')
- {
- (gripval=gripval-1);
- gripservo.write(gripval);
- delay(15);
- }
- else if (w == 'i'||w == 'I')
- {
- (gripval=gripval+1);
- gripservo.write(gripval);
- delay(15);
- }
- else if (w == 'j'||w == 'J')
- {
- (tjval=tjval-1);
- tjservo.write(tjval);
- delay(15);
- }
- else if (w == 'l'||w == 'L')
- {
- (tjval=tjval+1);
- tjservo.write(tjval);
- delay(15);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement