Advertisement
Guest User

ALL

a guest
Oct 17th, 2019
200
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <Servo.h>
  2. #define servo_a_pin 5
  3. #define servo_b_pin 6
  4. #define up 8
  5. #define down 9
  6. #define right 10
  7. #define left 11
  8. Servo servoVert, servoHor;
  9.  
  10. int x_pos = 0;
  11. int y_pos=0;
  12. int x_step=3;
  13. int y_step=2;
  14.  
  15.  
  16. void setup() {
  17.   // put your setup code here, to run once:
  18.   servoVert.attach(servo_a_pin);
  19.   servoHor.attach(servo_b_pin);
  20.   pinMode(up, INPUT_PULLUP);
  21.   pinMode(down, INPUT_PULLUP);
  22.   pinMode(left, INPUT_PULLUP);
  23.   pinMode(right, INPUT_PULLUP);
  24.  
  25.   Serial.begin(9600);
  26. }
  27.  
  28. void loop() {
  29.   // put your main code here, to run repeatedly:
  30.   /*
  31.   servoVert.write(90);
  32.   delay(500);
  33.   servoHor.write(270);
  34.   delay(500);
  35.   servoVert.write(0);
  36.   servoHor.write(0);
  37.   delay(500);
  38.   *//*
  39.   int y_step=2;//y_step
  40.   int x_step=10;
  41.   int del = 25;
  42.   int x_pred = 180;
  43.   int y_pred = 150;
  44.  
  45.   for (int i=0; i<=x_pred;i=i+x_step){
  46.     servoHor.write(i);
  47.    
  48.     for (int y=0; y<=y_pred;y=y+y_step){
  49.       Serial.print(i);
  50.       servoVert.write(y);
  51.       Serial.print("||");
  52.       Serial.println(y);
  53.       delay(del);
  54.     }
  55.     for (int y=y_pred; y>=0;y=y-y_step){
  56.       Serial.print(i);
  57.       servoVert.write(y);
  58.       Serial.print("||");
  59.       Serial.println(y);
  60.       delay(del);
  61.     }
  62.   }
  63.     for (int i=x_pred; i>=0;i=i-x_step){
  64.     servoHor.write(i);
  65.     for (int y=0; y<=y_pred;y=y+y_step){
  66.       Serial.print(i);
  67.       servoVert.write(y);
  68.       Serial.print("||");
  69.       Serial.println(y);
  70.       delay(del);
  71.     }
  72.     for (int y=y_pred; y>=0;y=y-y_step){
  73.       Serial.print(i);
  74.       servoVert.write(y);
  75.       Serial.print("||");
  76.       Serial.println(y);
  77.       delay(del);
  78.     }
  79.   }*/
  80.  
  81.  
  82.   int upVal = digitalRead(up);
  83.   int downVal = digitalRead(down);
  84.   int leftVal = digitalRead(left);
  85.   int rightVal = digitalRead(right);
  86.   Serial.print(upVal);
  87.   Serial.print("||");
  88.   Serial.print(downVal);
  89.   Serial.print("||");
  90.   Serial.print(leftVal);
  91.   Serial.print("||");
  92.   Serial.println(rightVal);
  93.   if (upVal==LOW){
  94.     y_pos-=y_step;  
  95.   }
  96.   if (downVal==LOW){
  97.     y_pos+=y_step;
  98.   }
  99.   if (rightVal==LOW){
  100.     x_pos+=x_step;
  101.   }
  102.   if (leftVal==LOW){
  103.     x_pos-=x_step;
  104.   }
  105.  
  106.   if (y_pos<0){y_pos=0;}
  107.   if (x_pos<0){x_pos=0;}
  108.   if (y_pos>180){y_pos=180;}
  109.   if (x_pos>180){x_pos=180;}
  110.  
  111.   servoVert.write(y_pos);
  112.   servoHor.write(x_pos);
  113. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement