请问怎么写程序能够控制舵机旋转0-90度,停留3秒,再从90转回0度?

请问怎么写程序能够控制舵机旋转0-90度,停留3秒,再从90转回0度?,第1张

控制舵机宜采用两个定时器,第一个定时器定时20mS,定时结带棚束,让某一管脚输出高电平,同时橘行指打开另一定时圆配器,该定时器定时1.5至2.5mS,定时结束输出低电平,同时关闭自身。改变第二个定时器的时间,舵机即出现不同的角度。

以下程序可供参考

//用一个定时器定时100US产生PWM波

//周期200*100us=20ms

//改变b的值族郑谈可改兆碰变占空比 b=10对应高电平时间1ms

#include<STC12C5A.H>

#define uchar unsigned char

#define uint unsigned int

sbit PWM=P2^0

uchar a=200,b=15//b=15对应舵机0度

void Delay1ms(uint i) //1ms延时程序

{

uint j

for(i>0i--)

{

for(j=0j<125j++)

{}

}

}

void main()

{

TMOD=0X01

TH0=(65536-100)/256

TL0=(65536-100)%256

ET0=1

EA=1

TR0=1

P1M0=0X0F//低4位推挽输出 控制两个电机正反转

P1M1=0X00

P2M0=0X01//最低位推挽输出 控制舵机

P2M1=0X00

while(1)

{

P1=0x0a

b=15Delay1ms(2000)//直行

b=10Delay1ms(1000)//左转

b=15Delay1ms(2000)//直行

b=20Delay1ms(1000)//丛喊右转

b=15Delay1ms(2000)//直行

P1=0x05

b=15Delay1ms(2000)//后退

b=10Delay1ms(1000)//后左转

b=15Delay1ms(2000)//后退

b=20Delay1ms(1000)//后右转

b=15Delay1ms(2000)//后退

}

}

void timer0()interrupt 1

{

TH0=(65536-100)/256

TL0=(65536-100)%256

a++

if(a<=b) PWM=1

else PWM=0

if(a==200){a=0PWM=1}

}

定时器0表示的是脉冲总周期20ms,定时器1表示的是正脉冲宽度(如pwm_value = 1500时表示正缓简脉冲宽度为1.5ms), 而while循序只是为了改变正脉冲宽度。运行过程是:定时器0和定时器,1同时开启,此时pwm = 1,定时器1的时间到了之后pwm = 0,并关闭定时器1,等待脉冲总周期达到20ms即定时器0中断,在定时器0的中断服务中又将pwm赋值为1并开启定时器1……以这样的方式循环就可以控制舵机转动了芦哪竖陪大!


欢迎分享,转载请注明来源:内存溢出

原文地址: http://outofmemory.cn/yw/12355683.html

(0)
打赏 微信扫一扫 微信扫一扫 支付宝扫一扫 支付宝扫一扫
上一篇 2023-05-24
下一篇 2023-05-24

发表评论

登录后才能评论

评论列表(0条)

保存