#include<Servo.h>
//定义舵机
int pos=0;
int val;
int in1=2;
int in2=4;
int in3=6;
int in4=7;
int ena=3;
int enb=5;
int tous=8;
int jians=9;
//定义针脚
Servo myservo;
//定义舵机名称
void setup() {
pinMode(in1,OUTPUT);
pinMode(in2,OUTPUT);
pinMode(in3,OUTPUT);
pinMode(in4,OUTPUT);
pinMode(ena,OUTPUT);
pinMode(enb,OUTPUT);
pinMode(tous,INPUT);
pinMode(jians,INPUT);
Serial.begin(9600);
//初始化所有针脚
myservo.attach(10); // put your setup code here, to run once:
//定义舵机名称
}
void loop() {
//判断投球键是否按下
int a=digitalRead(tous);
int b=digitalRead(jians);
if(tous==1);
{
Serial.println(1);
delay(100);
}
//判断捡球键是否按下
if(jians==1);
{
Serial.println(2);
delay(100);
}
}
void f()
{
for(pos=0;pos<=170;pos+=1); // put your main code here, to run repeatedly:
{
myservo.write(pos);
delay(5);
}
delay(1000);
for(pos=170;pos>=90;pos-=1)
{
myservo.write(pos);
delay(10);
}
}
void qian()
{
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
digitalWrite(in3,LOW);
digitalWrite(in4,HIGH);
digitalWrite(ena,HIGH);
digitalWrite(enb,HIGH);
}
void hou()
{
digitalWrite(in1,HIGH);
digitalWrite(in2,LOW);
digitalWrite(in3,HIGH);
digitalWrite(in4,LOW);
digitalWrite(ena,HIGH);
digitalWrite(enb,HIGH);
}
void zuo()
{
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
digitalWrite(in3,LOW);
digitalWrite(in4,HIGH);
digitalWrite(ena,LOW);
digitalWrite(enb,HIGH);
}
void you()
{
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
digitalWrite(in3,LOW);
digitalWrite(in4,LOW);
digitalWrite(ena,HIGH);
digitalWrite(enb,LOW);
}
void ting()
{
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
digitalWrite(in3,LOW);
digitalWrite(in4,HIGH);
digitalWrite(ena,LOW);
digitalWrite(enb,LOW);
} |