Advertisement
Guest User

Arduino code

a guest
Jul 31st, 2013
220
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <Servo.h>
  2.  
  3. Servo bjservo;
  4. Servo bjservo2;
  5. Servo mjservo;
  6. Servo tjservo;
  7. Servo gripservo;
  8.  
  9. int bjval = 0;
  10. int mjval = 0;
  11. int tjval = 179;
  12. int gripval = 179;
  13.  
  14. const unsigned int BAUD_RATE = 9600;
  15. char w = 0;
  16.  
  17. void setup()
  18. {
  19.   bjservo.attach(7);
  20.   bjservo2.attach(6);
  21.   mjservo.attach(5);
  22.   tjservo.attach(4);
  23.   gripservo.attach(3);
  24.   bjservo.write(bjval);
  25.   bjservo2.write(179-bjval);
  26.   mjservo.write(mjval);
  27.   tjservo.write(tjval);
  28.   gripservo.write(gripval);
  29.   Serial.begin(9600);
  30. }
  31.  
  32. void loop()
  33. {
  34.  
  35.   if (Serial.available()) {
  36.     w = Serial.read();
  37.     if (w == 'w'||w == 'W')
  38.     {
  39.       (bjval=bjval-1);
  40.       bjservo.write(bjval);
  41.       bjservo2.write(179-bjval);
  42.       delay(15);
  43.     }
  44.     else if (w == 's'||w == 'S')
  45.     {
  46.      (bjval=bjval+1);
  47.       bjservo.write(bjval);
  48.       bjservo2.write(179-bjval);
  49.       delay(15);
  50.     }
  51.     else if (w == 'a'||w == 'A')
  52.     {
  53.       (mjval=mjval-1);
  54.       mjservo.write(mjval);
  55.       delay(15);
  56.     }
  57.     else if (w == 'd'||w == 'D')
  58.     {
  59.       (mjval=mjval+1);
  60.       mjservo.write(mjval);
  61.       delay(15);
  62.     }
  63.     else if (w == 'k'||w == 'K')
  64.     {
  65.       (gripval=gripval-1);
  66.       gripservo.write(gripval);
  67.       delay(15);
  68.     }
  69.     else if (w == 'i'||w == 'I')
  70.     {
  71.       (gripval=gripval+1);
  72.       gripservo.write(gripval);
  73.       delay(15);
  74.     }
  75.     else if (w == 'j'||w == 'J')
  76.     {
  77.       (tjval=tjval-1);
  78.       tjservo.write(tjval);
  79.       delay(15);
  80.     }
  81.     else if (w == 'l'||w == 'L')
  82.     {
  83.       (tjval=tjval+1);
  84.       tjservo.write(tjval);
  85.       delay(15);
  86.     }
  87. }
  88. }
Advertisement
Advertisement
Advertisement
RAW Paste Data Copied
Advertisement