
int servopin = 7 //定义舵机接口数字接链蠢世口7
void servopulse(int angle)//定档让义一个脉冲函数
{
int pulsewidth=(angle*11)+500 //将角度转化为500-2480的脉宽值
digitalWrite(servopin,HIGH) //将舵机接口电平至高
delayMicroseconds(pulsewidth) //延时脉宽值的微秒数
digitalWrite(servopin,LOW)//将舵机接口电平至低
delayMicroseconds(20000-pulsewidth)
}
voidsetup()
{
pinMode(servopin,OUTPUT)//设定舵机接口为输出接口
}
voidloop()
{
//读取电位器(传感器)的读数,接到3.3V,值范围从0到660左右
int readValue = analogRead(readPin)
//把值的范围映射到0到165左右
int angle = readValue / 4
//发送50个脉冲
for(int i=0i<50i++)
{
//引用脉冲函数
servopulse(angle)
}
}
//12MHz#include <reg51.h>
void InitTimer0(void)
{
TMOD = 0x01
TH0 = 0x0B1
TL0 = 0x0E0
EA = 1
ET0 = 1
TR0 = 1
}
void delay(void) //误差 0us 延时1ms 此处可以修改高电平汪陆周期
//修改困逗顷此处的延时可以更改舵机转的角度 ,45度具体是多少 你指备可以试试
{
unsigned char a,b,c
for(c=1c>0c--)
for(b=142b>0b--)
for(a=2a>0a--)
}
void main(void)
{
InitTimer0()
P1_2=0
while(1)
}
void Timer0Interrupt(void) interrupt 1
{
//20ms中断
TH0 = 0x0B1
TL0 = 0x0E0
P1_2=1
delay()
P1_2=0
}
180度舵机是一特殊的机器人专用舵机。你所说的0-180度,在专业玩家里不这样说的,而是说成±90度。即顺时针90度,逆时针90度。你可以自己写一个的。这种舵机比陵告较特殊,但是只要满足尺明明一下PWM就可以实现了:
1. 周期T=20ms(即50HZ),占空比500us-2500us。槐困
2. 500us舵机逆时针转90度,2500us舵机顺时针转90读。 (其中0度是1500us)
3. 即: TL+TH=20ms 改变TH的值,舵机角度随之改变。参数参照以上1.2点。
TL TH
_____ ____
_________| |_________|| _________|
4. 电路原理很简单,接好电源,地,信号线。
信号线接到单片机或者其他能输出PWM的控制脚。
欢迎分享,转载请注明来源:内存溢出
微信扫一扫
支付宝扫一扫
评论列表(0条)