stm32控制舵機程序

電梯直達

樓主

ID:907565 發(fā)表于 2021-7-15 13:02 | 只看該作者回帖獎勵

單片機控制舵機程序，用的是原字的定時器中斷實驗改的

單片機源程序如下:

#include "pwm.h"
#include "delay.h"
#include "sys.h"
#include "usart.h"
#include "timer.h"
u8 JD=0;
u32 a0,a1;
u8 flag1=0,flag2=0;//定時器計數(shù)20ms到了的標志
int main(void)
{
u16 t1=0,t2=0;
u8 YS[6]={0,60,120,180,120,60};
delay_init(); //延時函數(shù)初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應(yīng)優(yōu)先級
uart_init(9600); //串口初始化為115200
PWM_Init(); //LED端口初始化
TIM3_Int_Init(9,71);//10us
// t1=(t1/180)*2000;
while(1)
{/*
PWM0=1;
delay_us(500+t1);//延時
PWM0=0;
delay_ms(20);//延時
*/
// if(flag1==1)
// {
// flag1=0;
// t2++;
// if(t2==50)
// JD=60;
// if(t2==100)
// JD=120;
// if(t2==150)
// JD=180;
// if(t2==200)
// JD=120;
// if(t2==250)
// JD=60;
// if(t2==300)
// {
// JD=0;
// t2=0;
// }
// }
if(flag2==1)
{
flag2=0;
JD=YS[t2];
t2++;
if(t2>=6)
{
t2=0;
}
}
}
}
//定時器3中斷服務(wù)程序
void TIM3_IRQHandler(void) //TIM3中斷
{
if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) //檢查TIM3更新中斷發(fā)生與否
{
TIM_ClearITPendingBit(TIM3, TIM_IT_Update ); //清除TIMx更新中斷標志
a0++;a1++;
/*************PWM0**************/
if(a0==(50+JD))
{
PWM0=0;
}
if(a0>=2000)
{
a0=0;
PWM0=1;
flag1=1;
}
if(a1>=100000)
{
a1=0;
flag2=1;
}
}
}