Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- #define servo_a_pin 5
- #define servo_b_pin 6
- #define up 8
- #define down 9
- #define right 10
- #define left 11
- Servo servoVert, servoHor;
- int x_pos = 0;
- int y_pos=0;
- int x_step=3;
- int y_step=2;
- void setup() {
- // put your setup code here, to run once:
- servoVert.attach(servo_a_pin);
- servoHor.attach(servo_b_pin);
- pinMode(up, INPUT_PULLUP);
- pinMode(down, INPUT_PULLUP);
- pinMode(left, INPUT_PULLUP);
- pinMode(right, INPUT_PULLUP);
- Serial.begin(9600);
- }
- void loop() {
- // put your main code here, to run repeatedly:
- /*
- servoVert.write(90);
- delay(500);
- servoHor.write(270);
- delay(500);
- servoVert.write(0);
- servoHor.write(0);
- delay(500);
- *//*
- int y_step=2;//y_step
- int x_step=10;
- int del = 25;
- int x_pred = 180;
- int y_pred = 150;
- for (int i=0; i<=x_pred;i=i+x_step){
- servoHor.write(i);
- for (int y=0; y<=y_pred;y=y+y_step){
- Serial.print(i);
- servoVert.write(y);
- Serial.print("||");
- Serial.println(y);
- delay(del);
- }
- for (int y=y_pred; y>=0;y=y-y_step){
- Serial.print(i);
- servoVert.write(y);
- Serial.print("||");
- Serial.println(y);
- delay(del);
- }
- }
- for (int i=x_pred; i>=0;i=i-x_step){
- servoHor.write(i);
- for (int y=0; y<=y_pred;y=y+y_step){
- Serial.print(i);
- servoVert.write(y);
- Serial.print("||");
- Serial.println(y);
- delay(del);
- }
- for (int y=y_pred; y>=0;y=y-y_step){
- Serial.print(i);
- servoVert.write(y);
- Serial.print("||");
- Serial.println(y);
- delay(del);
- }
- }*/
- int upVal = digitalRead(up);
- int downVal = digitalRead(down);
- int leftVal = digitalRead(left);
- int rightVal = digitalRead(right);
- Serial.print(upVal);
- Serial.print("||");
- Serial.print(downVal);
- Serial.print("||");
- Serial.print(leftVal);
- Serial.print("||");
- Serial.println(rightVal);
- if (upVal==LOW){
- y_pos-=y_step;
- }
- if (downVal==LOW){
- y_pos+=y_step;
- }
- if (rightVal==LOW){
- x_pos+=x_step;
- }
- if (leftVal==LOW){
- x_pos-=x_step;
- }
- if (y_pos<0){y_pos=0;}
- if (x_pos<0){x_pos=0;}
- if (y_pos>180){y_pos=180;}
- if (x_pos>180){x_pos=180;}
- servoVert.write(y_pos);
- servoHor.write(x_pos);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement