//a new try to make a DIY servo
//2015.7.15
#include"math.h"
int IN1 = 12;
int IN2 = 13;
int EN = 9;
void setup()
{
pinMode(IN1,OUTPUT);
pinMode(IN2,OUTPUT);
pinMode(EN,OUTPUT);
}
void loop()
{
int a = analogRead(A0) - analogRead(A1);
int b = abs(a);
if (b <= 2)
{
digitalWrite(IN1,LOW);
digitalWrite(IN2,LOW);
analogWrite(EN,0);
}
else
{
if (analogRead(A0) > analogRead(A1))
{
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
analogWrite(EN,255);
}
else
{
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
analogWrite(EN,255);
}
}
delay(15);
}
成功了
{:soso_e109:} |