基于STM32F4的飛控程序源代碼下載

ID:433240 · 發表于 2018-11-26 10:39

和固定翼不同，沒有飛控，多旋翼無法操控。
直到以下飛控的出現，
Kiss
Lux
CC3D
F3及變種
F4及變種
F7及變種
這些飛控通過多種傳感器和主控芯片，控制著機身多個電機，調整機身的姿態。
飛控的選擇，會影響多旋翼的飛行感受。而固件則是飛控的靈魂。
以下放出了F4飛控的程序源代碼，需要的可以自行下載，謝謝。

單片機源程序如下:

#include "stm32f4xx.h"
#include "delay.h"
#include "led.h"
#include "timer.h"
#include "pwm_output.h"
#include "usart.h"
#include "pwm_in.h"
#include "MPU6050.h"
#include "IIC.h"
#include "imu.h"
#include "control.h"
/*------------------------------------------------------------------------------------------*/
/* global varibles */
/*------------------------------------------------------------------------------------------*/
unsigned char tim2flag=0; //定時期2中斷任務執行標志
unsigned char readyflag=0; //任務執行標志 0:初始化kp,kd;1:電機執行許可；2:執行電機執行許可和發送角度信息
/*------------------------------------------------------------------------------------------*/
/* function code */
/*------------------------------------------------------------------------------------------*/
void TIM2_IRQHandler(void);
void NVIC_Configuration(void);
void USART3_IRQHandler(void);
int main(void)
{
float Roll=0;
float Pitch=0;
int i=0;
LED_Init();
LED1_OFF;
LED2_OFF;
LED3_OFF;
LED4_OFF;
delay_init(168); //延時初始化并啟動開機時間。
NVIC_Configuration();
usart_x_init(115200);
Timer2_Init(40,8399);
pwm_in_init();
TIM5_PWM_Init(); //PWM輸出初始化250hz
TIM4_PWM_Init(); //50hz
delay_ms(100);
for(i=0;i<10000;i++) //用以初始化電調航程的時間
{
TIM5_PWM_OUTPUT(pwmout2,pwmout2,pwmout2,pwmout2);
delay_ms(1);
}
delay_ms(100);
I2C_GPIO_Config();
delay_ms(100);
Init_MPU6050();
Acc_Correct();
Gyro_Correct();
PID_controllerInit();
controlmiddleinit(pwmout1,pwmout2,pwmout3,pwmout4); // pwmout1:橫滾 pwmout2:油門
// pwmout3:俯仰 pwmout4:航向
// printf("\n\rUSARTx test:\n\r");
delay_ms(500);
delay_ms(500);
LED1_OFF;
LED2_ON;
LED3_ON;
LED4_OFF;
while(1)
{
if(tim2flag!=0)
{
tim2flag=0;
// READ_MPU6050();
// MPU6050_TEST();
IMUdataprepare();
IMUupdate(GyroFinal.X,GyroFinal.Y,GyroFinal.Z,AccFinal.X,AccFinal.Y,AccFinal.Z);
Roll=(float)atan2(AccFinal.Y,AccFinal.Z)*57.295779513; //X軸角度值
Pitch=-(float)atan2(AccFinal.X,AccFinal.Z)*57.295779513; //Y軸角度值
// SendData(Q_ANGLE.Pitch*10,Pitch*10,Q_ANGLE.Roll*10,Roll*10);
SendData(Q_ANGLE.Yaw*10,Q_ANGLE.Pitch*10,Q_ANGLE.Roll*10,0); //配合diIMU上位機，單位度*10 紅藍青黃
// SendData(0,Pitch*10,0,Roll*10);
// SendData(0,GyroFinal.X*10,0,GyroFinal.Y*10);
Getdesireddata(pwmout1,pwmout2,pwmout3,pwmout4);
// Q_ANGLE.Roll=-Q_ANGLE.Roll;
PID_CAL();
TIM5_PWM_OUTPUT(MOTOR1,MOTOR2,MOTOR3,MOTOR4); //MOTOR1 REAR_R 后右電機
//MOTOR2 FRONT_R 前右電機
//MOTOR3 REAR_L 后左電機
//MOTOR4 FRONT_L 前左電機
// TIM5_PWM_OUTPUT(pwmout2,pwmout2,pwmout2,pwmout2);
platform_control(Q_ANGLE.Roll,Q_ANGLE.Pitch,0,0);
TIM4_PWM_OUTPUT(servo_Roll,servo_Pitch);
// SendData(Q_ANGLE.Roll*10,(&pidRoll)->outP,(&pidRoll)->outD,0);
// SendData(MOTOR1*10,MOTOR2*10,MOTOR3*10,MOTOR4*10);
LED1_Tog;
}
}
}
void NVIC_Configuration(void)
{
NVIC_InitTypeDef NVIC_InitStructure;
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4); //中斷分組0 先占優先級4位。從優先級0位
//Usart1 NVIC 配置
NVIC_InitStructure.NVIC_IRQChannel = USART3_IRQn;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=3 ;
// NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3; //
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道使能
NVIC_Init(&NVIC_InitStructure); //根據NVIC_InitStruct中指定的參數初始化外設NVIC寄存器USART1
//TIM2定時中斷設置
NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn; //TIM3中斷
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2; //先占優先級0級
// NVIC_InitStructure.NVIC_IRQChannelSubPriority = 2; //從優先級3級
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
NVIC_Init(&NVIC_InitStructure); //根據NVIC_InitStruct中指定的參數初始化外設NVIC寄存器
//中斷分組初始化
NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn; //TIM5中斷
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //先占優先級2級
// NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //從優先級0級
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
NVIC_Init(&NVIC_InitStructure); //根據NVIC_InitStruct中指定的參數初始化外設NVIC寄存器
}
void TIM2_IRQHandler(void) //TIM2中斷
{
if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) //檢查指定的TIM中斷發生與否:TIM 中斷源
{
TIM_ClearITPendingBit(TIM2, TIM_IT_Update ); //清除TIMx的中斷待處理位:TIM 中斷源
}
// LED4_Tog;
tim2flag++;
}
void USART3_IRQHandler(void) //串口1中斷服務程序
{
char ch;
LED1_OFF;
LED3_ON;
if(USART_GetITStatus(USART3, USART_IT_RXNE) != RESET) //接收中斷
{
ch =USART_ReceiveData(USART3);//(USART3->DR); //讀取接收到的數據
USART3_SendData(ch);
}
}

復制代碼

所有資料51hei提供下載:

軟件源代碼.zip (447 KB, 下載次數: 240)

ID:404223 · 發表于 2019-1-18 21:44

感謝提供共享，已收藏

ID:64913 · 發表于 2019-1-23 21:52

要是有原理圖就好了

ID:229821 · 發表于 2019-4-11 12:17

謝謝分享。收藏了。真好。

ID:140642 · 發表于 2019-6-9 10:07

好東西，收藏看看。

ID:516571 · 發表于 2019-6-12 19:01

感謝分享，已經收藏

ID:599303 · 發表于 2019-8-12 10:53

沒有濾波？

ID:621821 · 發表于 2019-10-10 16:51

這個好，感謝分享。

ID:261045 · 發表于 2019-10-25 23:21

謝謝，正需要這個飛控源碼！！

ID:688334 · 發表于 2020-1-27 19:02

51黑有你更精彩！！

ID:628703 · 發表于 2020-3-18 15:17

謝謝分享，以收藏！

帳號		自動登錄	找回密碼
密碼			立即注冊

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

基于STM32F4的飛控程序源代碼下載