四旋翼飞行器的飞控程序
四旋翼飞行器的飞控程序,基于
#include "include.h"
float tem;
int main(void)
{
delay_init(SYSCLK_FREQ_72);
uart_init(72,115200);
AFIO_Init();
GPIO_Init(GPIOB,Pin_5,GPO_PP_50,LOW);
GPIO_Init(GPIOC,Pin_13,GPO_PP_50,LOW);
Ultra_Init(); //超声波初始化
TIM_PPM_Init(); //遥控器采集初始化
TIM_PWM_Init(CH1,400,4000); //电机控制初始化
TIM_PWM_Init(CH2,400,4000);
TIM_PWM_Init(CH3,400,4000);
TIM_PWM_Init(CH4,400,4000);
ANBT_I2C_Configuration(); //IIC初始化
delay_ms(500);
AnBT_DMP_MPU6050_Init(); //6050DMP初始化
delay_ms(500);
InitHMC5883(); //HMC5883初始化
delay_ms(500);
updateHMC5883();
tem=MAG_angle;
delay_ms(500);
Wake_up_Lock();
FTM_Init(2);
while(1)
{
UnLock_Lock();
}
}
stm32,利用mpu6050内部自带的DMP融合姿态角,采用串级PID算法来完成平衡控制。有很大的参考价值。
- 2022-07-17 11:37:24下载
- 积分:1