通过对大佬的学习(COPY),自己做了一个Arduino的舵机库,在调试的时候出现了很无奈的事情,直接让舵机转动90 180 270 360的时候办法转到准确的度数,但是用for循环10度10 度转的话就可以转到。。。。
代码如下
mySERVO.h
#ifndef mySERVO_H
#define mySERVO_H
#include"Arduino.h"
class mySERVO
{
public:
mySERVO(int servopwm);
void angle(int angle);
private:
int i;
int servo_pin;
int pulsewidth;
};
#endif
mySERVO.cpp
#include"Arduino.h"
#include"mySERVO.h"
mySERVO::mySERVO(int SERVOPIN)
{
servo_pin=SERVOPIN;
pinMode(servo_pin,OUTPUT);
}
void mySERVO::angle(int anglevalue)
{
pulsewidth=(int)(anglevalue*5.5)+500;
for(int i=0;i<50;i++) //发送50个脉冲
{
digitalWrite(servo_pin,HIGH); //将舵机接口电平至高,反过来也是可以的
delayMicroseconds(pulsewidth); //延时脉宽值的微秒数
digitalWrite(servo_pin,LOW);
delayMicroseconds(2000-pulsewidth);
}
}
舵机以10的幅度增加角度的程序
#inclue<mySERVO.h>
mySERVO servo(5);
void setup()
{
}
void loop()
{
for(int i=0;i<360;i=i+10)
{
servo.angle(i);
delay(1000);
}
}
舵机直接转到 0,90,180,270,360的角度的程序
#include<mySERVO.h>
mySERVO servo(5);
void setup()
{
Serial.begin(9600);
}
void loop()
{
servo.angle(0);
Serial.println(0);
delay(5000);
servo.angle(90);
Serial.println(90);
delay(5000);
servo.angle(180);
Serial.println(180);
delay(5000);
servo.angle(270);
Serial.println(270);
delay(5000);
servo.angle(360);
Serial.println(360);
delay(5000);
}
在直接转到对应角度的时候,老是出现角度偏差,而且偏差很大~~~~~~