西华大学毕业设计说明书 3.部分程序
主程序:
//Copter_Board
#include \//Copter_System
#include \int main(void) { Quadcopter_Board_Init(); //初始化飞控板设置 Copter_Core_Init(); //初始化参数 Sensor_Init(); //传感器初始化 //启用独立看门狗 IWDG_Init(4,1000); //与分频数为64,重载值为1000,溢出时间为2s while(1) { if((USART_RX_STA&0x80)==0x80) //接收数据完成 { Data_Receive(USART_RX_BUF,&Num); //处理上位机数据 USART_RX_STA=0; //数组清0,接收完成标志清0 } switch (IRQ_Sign) { case 1: //MPU6050DMP中断 if(IS_LOCK==0) //解锁后才开始平衡姿态 { Balance_Atitude(pit,rol,yaw,pit_T,rol_T,yaw_T,Gyro); //Balance_Height(Height,Height_T); } IRQ_Sign = 0; break; }
if((throttle==1000)||(IS_LOCK==1)) //积分清0
{ PID_ROL_ANGLE.iout=PID_PIT_ANGLE.iout=PID_YAW_ANGLE.iout=0; PID_ROL_RATE.iout =PID_PIT_RATE.iout =PID_YAW_RATE.iout =0; } if((abs(rol)>50)||(abs(pit)>50)||(abs(yaw)>70))//倾角保护 { moto1=moto2=moto3=moto4=1000; IS_LOCK=1; //上锁指示灯开启 过角度 警报 throttle=1000;
第 44 页
西华大学毕业设计说明书
}
}
}
Motor_Out(); IWDG_Feed();
//喂狗
中断:
void EXTI0_IRQHandler(void) //外部中断0服务程序 {
if(EXTI_GetITStatus(EXTI_Line0)!=RESET) //判断某个线上的中断是否发生 { mpu_dmp_get_data(Gyro,&pit,&rol,&yaw); //获取DMP数据 EXTI_ClearITPendingBit(EXTI_Line0); //清除LINE0上的中断标志位 IRQ_Sign = 1; } }
void USART1_IRQHandler(void) //串口1中断服务程序 { u8 Res;
if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET) { Res=USART_ReceiveData(USART1); //读取接收到的数据 //接收协议start if((USART_RX_STA&0x80)==0)//接收数据未完成 { USART_RX_BUF[USART_RX_STA&0X7F]=Res; USART_RX_STA++; if(USART_RX_STA==0x02) { if(!((USART_RX_BUF[0]==0xAA)&&(USART_RX_BUF[1]==0x55))) USART_RX_STA=0; //帧头错误,重新开始 } if(USART_RX_STA==0x04) Num=USART_RX_BUF[3];//获取数据个数 if(USART_RX_STA>(USART_REC_LEN-1)) USART_RX_STA=0; //接收到的个数大于容量,重新开始接收 //小于容量并且帧头正确,继续接收 if(((USART_RX_STA&0X7F)==Num)&&(Num>4)) USART_RX_STA|=0x80; //置标志位0x80表示接收数据完成 } //接收协议end } }
第 45 页
西华大学毕业设计说明书 4.外文翻译
第 46 页
百度搜索“77cn”或“免费范文网”即可找到本站免费阅读全部范文。收藏本站方便下次阅读,免费范文网,提供经典小说综合文库基于STM32的四旋翼飞行控制系统毕业设计 - 图文(5)在线全文阅读。
相关推荐: