免费成人高清在线视频,www.99久,91精品一区二区三区久久久久

#include "led.h"
#include "delay.h"
#include "sys.h"
#include "usart.h"
#include "adc.h"
#include "crc.h"
#include "timer.h"
#include "exti.h"
#define TIMES 5 //0.5 進5次反轉一次
#define INIT_STEPS1 500
#define INIT_STEPS2 500
#define INIT_STEPS3 500
#define INIT_STEPS4 500
#define INIT_STEPS5 500
u16 StepNum[5]; //走的步數
u8 Move_Flag[5]; //走不走
u8 Move_Dir_Flag[5]; //走的方向
u8 receive[20]; //接收的數據
u8 send[20]; //發送的數據
u16 crc;
u8 k =0;
u16 Total_times; //運行要走的來回數目；
u8 Runing_flag; //運行的標志位
u16 Real_times;//運行真實走的次數；
u8 Init_flag; //初始化標志位
u8 Init_motor_num = 0; //初始化時逐一初始化
//初始值始終為0
u8 i; //定時器標志位
u8 j = 0; //每個電機的循環
u16 Real_Step[5]; //實際走的步數
u8 Res;
u8 p=0;
int main(void)
{
delay_init(); //延時函數初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//設置中斷優先級分組為組2：2位搶占優先級，2位響應優先級
uart_init(115200); //串口初始化為115200
LED_Init(); //LED端口初始化
Key_Init();
send[0]=0x55;
send[1]=0x02;
ENA1 = 0;
ENA2 = 0;
ENA3 = 0;
ENA4 = 0;
ENA5 = 0;
PWM1 = 1;
PWM2 = 1;
PWM3 = 1;
PWM4 = 1;
PWM5 = 1;
EXTIX_Init();
TIM3_Int_Init(4,799);//0.5ms進一次定時器
while(1)
{
delay_ms(1000);
// PWM1=~PWM1;
// PWM5=~PWM5;
// PWM2=~PWM2;
// PWM3=~PWM3;
// PWM4=~PWM4;
LED0=~LED0;
}
}
//定時器3中斷服務程序
void TIM3_IRQHandler(void) //TIM3中斷
{
if (TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET) //檢查TIM3更新中斷發生與否
{
i++;
if(i>=TIMES)
{
i=0;
if(Init_flag !=0)
{
if(Init_flag ==1 )
{
switch(Init_motor_num)
{
case 1:
if(PWM1 == 1)
{
PWM1=0;
}
else
{
PWM1=1;
}
break;
case 2:
if(PWM2 == 1)
{
PWM2=0;
}
else
{
PWM2=1;
}
break;
case 3:
if(PWM3 == 1)
{
PWM3=0;
}
else
{
PWM3=1;
}
break;
case 4:
if(PWM4 == 1)
{
PWM4=0;
}
else
{
PWM4=1;
}
break;
case 5:
if(PWM5 == 1)
{
PWM5=0;
}
else
{
PWM5=1;
}
break;
}
}
else
{
switch(Init_motor_num)
{
case 1:
if(PWM1 == 1)
{
PWM1=0;
Real_Step[0]++;
}
else
{
PWM1=1;
if(Real_Step[0]>=INIT_STEPS1) //走夠了
{
ENA1 = 0;
ENA2 = 1;
Real_Step[0]=0;
Init_motor_num++;
Init_flag = 1;
}
}
break;
case 2:
if(PWM2 == 1)
{
PWM2=0;
Real_Step[1]++;
}
else
{
PWM2=1;
if(Real_Step[1]>=INIT_STEPS2) //走夠了
{
ENA2 = 0;
ENA3 = 1;
Real_Step[1]=0;
Init_motor_num++;
Init_flag = 1;
}
}
break;
case 3:
if(PWM3 == 1)
{
PWM3=0;
Real_Step[2]++;
}
else
{
PWM3=1;
if(Real_Step[2]>=INIT_STEPS3) //走夠了
{
ENA3 = 0;
ENA4 = 1;
Real_Step[2]=0;
Init_motor_num++;
Init_flag = 1;
}
}
break;
case 4:
if(PWM4 == 1)
{
PWM4=0;
Real_Step[3]++;
}
else
{
PWM4=1;
if(Real_Step[3]>=INIT_STEPS4) //走夠了
{
ENA4 = 0;
ENA5 = 1;
Real_Step[3]=0;
Init_motor_num++;
Init_flag = 1;
}
}
break;
case 5:
if(PWM5 == 1)
{
PWM5=0;
Real_Step[4]++;
}
else
{
PWM5=1;
if(Real_Step[4]>=INIT_STEPS5) //走夠了
{
ENA5 = 0;
Real_Step[4]=0;
Init_motor_num = 0;
Init_flag = 0;
send[2]=0x02;
send[3]=0x02;
send[4] = 1;
send[5] = 2;
send[6] = 0xaa;
send[7] = 0xbb;
for(j=0;j<8;j++) //發送步數
{
USART_SendData(USART1, send[j]);//向串口1發送數據
while(USART_GetFlagStatus(USART1,USART_FLAG_TC)!=SET);//等待發送結束
}
}
}
break;
}
}
}
}
else
{
if(Runing_flag==1) //運行
{
if(Move_Dir_Flag[0]==0) //走的方向
DIR1 = 0;
else
DIR1 = 1;
if(PWM1 == 1)
{
PWM1=0;
Real_Step[0]++;
}
else
{
PWM1=1;
if(Real_Step[0]>=StepNum[0]) //走夠了
{
Real_Step[0]=0;
if(Move_Dir_Flag[0]==1) //走的方向
Move_Dir_Flag[0] = 0;
else
{
Move_Dir_Flag[0] = 1;
Real_times++;
send[2]=0x01;
send[3]=0x02;
send[4] = Real_times/256;
send[5] = Real_times%256;
send[6] = 0xaa;
send[7] = 0xbb;
for(j=0;j<8;j++) //發送步數
{
USART_SendData(USART1, send[j]);//向串口1發送數據
while(USART_GetFlagStatus(USART1,USART_FLAG_TC)!=SET);//等待發送結束
}
if(Real_times>=Total_times) //次數達到了
{
ENA1 = 0;
Real_Step[0]=0;
Runing_flag= 0;
PWM1=1;
}
}
}
}
}
else
{
if(Move_Flag[0]==1) //1號電機要轉
{
if(Move_Dir_Flag[0]==0) //走的方向
DIR1 = 0;
else
DIR1 = 1;
if(PWM1 == 1)
{
PWM1=0;
Real_Step[0]++;
}
else
{
PWM1=1;
if(Real_Step[0]>=StepNum[0]) //走夠了
{
ENA1 = 0;
Move_Flag[0] = 0;
Real_Step[0]=0;
StepNum[0] = 0;
}
}
}
if(Move_Flag[1]==1) //1號電機要轉
{
if(Move_Dir_Flag[1]==0) //走的方向
DIR2 = 0;
else
DIR2 = 1;
if(PWM2 == 1)
{
PWM2=0;
Real_Step[1]++;
}
else
{
PWM2=1;
if(Real_Step[1]>=StepNum[1]) //走夠了
{
ENA2 = 0;
Move_Flag[1] = 0;
Real_Step[1]=0;
StepNum[1] = 0;
}
}
}
if(Move_Flag[2]==1) //1號電機要轉
{
if(Move_Dir_Flag[2]==0) //走的方向
DIR3 = 0;
else
DIR3 = 1;
if(PWM3 == 1)
{
PWM3=0;
Real_Step[2]++;
}
else
{
PWM3=1;
if(Real_Step[2]>=StepNum[2]) //走夠了
{
ENA3 = 0;
Move_Flag[2] = 0;
Real_Step[2]=0;
StepNum[2] = 0;
}
}
}
if(Move_Flag[3]==1) //1號電機要轉
{
if(Move_Dir_Flag[3]==0) //走的方向
DIR4 = 0;
else
DIR4 = 1;
if(PWM4 == 1)
{
PWM4=0;
Real_Step[3]++;
}
else
{
PWM4=1;
if(Real_Step[3]>=StepNum[3]) //走夠了
{
ENA4 = 0;
Move_Flag[3] = 0;
Real_Step[3]=0;
StepNum[3] = 0;
}
}
}
if(Move_Flag[4]==1) //1號電機要轉
{
if(Move_Dir_Flag[4]==0) //走的方向
DIR5 = 0;
else
DIR5 = 1;
if(PWM5 == 1)
{
PWM5=0;
Real_Step[4]++;
}
else
{
PWM5=1;
if(Real_Step[4]>=StepNum[4]) //走夠了
{
ENA5 = 0;
Move_Flag[4] = 0;
Real_Step[4]=0;
StepNum[4] = 0;
}
}
}
}
}
}
TIM_ClearITPendingBit(TIM3, TIM_IT_Update); //清除TIMx更新中斷標志
}
void USART1_IRQHandler(void) //串口1中斷服務程序
{
//1.緩沖數據
if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET) //接收中斷(接收到的數據必須是0x0d 0x0a結尾)
{
Res =USART_ReceiveData(USART1);//(USART1->DR); //讀取接收到的數據
}
receive[p++]=Res;
//2.完整性判斷
while(p>=6) //六個數據
{
//2.1查找數據頭
if(receive[0]==0x55)
{
u8 len=receive[3];
if(p<len+6)
{
break; //跳出接收函數后繼續接收數據
}
if(receive[len+4]==GetCRC16(receive,len+4)/256&&receive[len+5]==GetCRC16(receive,len+4)%256)//校驗成功
{
p=0;
switch (receive[2])
{
case 0x01: //一個電機要動
{
Move_Flag[receive[4]-1] = 1; //走不走
StepNum[receive[4]-1] = receive[5]*256+receive[6]; //走的步數
Move_Dir_Flag[receive[4]-1]=receive[7]; //走的方向
switch(receive[4])
{
case 1:
ENA1 = 1;
break;
case 2:
ENA2 = 1;
break;
case 3:
ENA3 = 1;
break;
case 4:
ENA4 = 1;
break;
case 5:
ENA5 = 1;
break;
}
break;
}
case 0x02: //多個電機動
{
for (j=0;j<5;j++)
{
Move_Flag[j] = 1; //走不走
StepNum[j] = receive[3*j+4]*256+receive[3*j+5];
Move_Dir_Flag[j] = receive[3*j+6]; //走的方向
Real_Step[j] = 0;
}
ENA1 = 1;
ENA2 = 1;
ENA3 = 1;
ENA4 = 1;
ENA5 = 1;
break;
}
case 0x03: //運行
{
StepNum[0] = receive[4]*256+receive[5];
Total_times = receive[6]*256+receive[7];
Move_Dir_Flag[0] = 1;
Real_Step[0]=0;
Runing_flag= 1;
Real_times = 0;
ENA1 = 1;
break;
}
case 0x04: //初始化
{
Init_flag = 1; //初始化標志位置1
DIR1 = 0;//先向右走
DIR2= 0;
DIR3= 0;
DIR4= 0;
DIR5= 0;
ENA1 = 1;
Init_motor_num = 1;
break;
}
case 0x05: //急停
{
PWM1= 1;
Move_Flag[0] = 0; //走不走
Real_Step[0] = 0;
Runing_flag= 0;
Real_times = 0;
Init_flag = 0; //初始化標志位置1
ENA1 = 0;
ENA2 = 0;
ENA3 = 0;
ENA4 = 0;
ENA5 = 0;
break;
}
}
}
else//校驗失敗
{
p=0;
continue;
}
}
else
{
//重新接收
p=0;
}
}
}
//外部中斷2服務程序
void EXTI2_IRQHandler(void)
{
if(Init_flag==1)
{
Init_flag = 2;
switch(Init_motor_num)
{
case 1:
PWM1 = 1;
DIR1 = 1;
Real_Step[0]=0;
break;
case 2:
PWM2 = 1;
DIR2 = 1;
Real_Step[1]=0;
break;
case 3:
PWM3 = 1;
DIR3 = 1;
Real_Step[2]=0;
break;
case 4:
PWM4 = 1;
DIR4 = 1;
Real_Step[3]=0;
break;
case 5:
PWM5 = 1;
DIR5 = 1;
Real_Step[4]=0;
break;
}
}
EXTI_ClearITPendingBit(EXTI_Line2); //清除LINE2上的中斷標志位
}

復制代碼

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费