基于STM32的四旋翼飞行控制系统毕业设计 - 图文(5)

2020-04-17 21:21

西华大学毕业设计说明书 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 页


基于STM32的四旋翼飞行控制系统毕业设计 - 图文(5).doc 将本文的Word文档下载到电脑 下载失败或者文档不完整,请联系客服人员解决!

下一篇:违法占地行政案件若干问题研究

相关阅读
本类排行
× 注册会员免费下载(下载后可以自由复制和排版)

马上注册会员

注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: