设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › 单片机DIY制作 › stm32f103单片机自制飞控代码分享
返回列表 发新帖
查看: 2302|回复: 1
打印 上一主题 下一主题
收起左侧

stm32f103单片机自制飞控代码分享

[复制链接]
跳转到指定楼层
楼主
ID:933779 发表于 2023-7-14 19:12 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
程序可以支持MPU6050数据读取、SPL06气压计读取、SBUS遥控数据读取、最多可以控制8路电机或者电调。写了PID算法，可以让无人机在控制保持稳定。
飞机是自制的，硬件和机械也是自己做的，
是本人设计一部分，硬件电路会在整理之后发出来。新人第一次发帖，还望各位大佬轻喷。
制作出来的实物图如下:


单片机源程序如下:
  1. #include "sys.h"

  3. u8 report=0;                        //默认开启上报
  4. int motor1,motor2,servo1,servo2;
  5. float Setpitch=0,Setroll=0;
  6. float pitch,roll,yaw;                 //欧拉角
  7. short aacx,aacy,aacz;                //加速度传感器原始数据
  8. short gyrox,gyroy,gyroz;        //陀螺仪原始数据
  9. short temp;                                        //温度       
  10. int main(void)
  11. {       
  12.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);         //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
  13.         Usart_init();                 //串口初始化
  14.         delay_init();          //延时初始化 delay_ms(1000);
  15.         BEEP_GPIO_Init();
  16.         Motor_PWM_Init(20000-1, 72-1);
  17.         Servo_PWM_Init(20000-1, 72-1);
  18.         TIM2_Int_Init(100-1,720-1);
  19.         Motor_Unlock(1900,1100);
  20.         BEEP_GPIO_High();
  21.         FrSky_Uart2_Init(100000);
  22.         Adc_Init();
  23.         SPI1_Init();
  24.         SPL06_Init();
  25.         MPU_IIC_Init(); //MPU使用的IIC初始化
  26.         while(MPU_Init())
  27.         {
  28.                 printf("mpu error\n");
  29.                 delay_ms(200);
  30.         };                                        //初始化MPU6050
  31.        
  32.         while(mpu_dmp_init())
  33.         {
  34.                 printf("mpu dmp error\n");
  35.                 delay_ms(200);
  36.         }
  37.   PID_Init();
  38.         BEEP_GPIO_Low();

  40.         while(1)
  41.         {

  43.                 int i;
  44.                 static float Baro_Buf[20];
  45.                 Baro.Org_Alt = SPL06_Get_Altitude();
  46.                 //气压原始数据缓存
  47.     for(i=19;i>0;i--)
  48.     {
  49.         Baro_Buf[i]=Baro_Buf[i-1];
  50.     }
  51.     Baro_Buf[0]=Baro.Org_Alt;

  53. //                printf("%f\n",Baro.Org_Alt );
  54. //                delay_ms(100);
  55. /********测量电池电压********/
  56.                
  57.                 Get_Bat_Voltage();
  58.                 if(Bat_Voltage<11)
  59.                 {
  60.                         BEEP_GPIO_High();
  61.                 }
  62.                 else
  63.                 {
  64.                         BEEP_GPIO_Low();
  65.                 }
  66. //////                printf("电池电压为 %f \n",Bat_Voltage);
  67. ///**********陀螺仪数据输出***************/               
  68. if(mpu_dmp_get_data(&pitch,&roll,&yaw)==0)
  69. {
  70. //        printf("%f,%f,%f\r\n",pitch,roll,yaw);
  71.         temp=MPU_Get_Temperature();        //得到温度值
  72.         MPU_Get_Accelerometer(&aacx,&aacy,&aacz);        //得到加速度传感器数据
  73.         MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);        //得到陀螺仪数据
  74.         if(report)mpu6050_send_data(aacx,aacy,aacz,gyrox,gyroy,gyroz);//用自定义帧发送加速度和陀螺仪原始数据
  75.         if(report)usart1_report_imu(aacx,aacy,aacz,gyrox,gyroy,gyroz,(int)(roll*100),(int)(pitch*100),(int)(yaw*10));

  77. }
  78. /********     根据无线串口输入并调整pid   ********/
  79.         PID_Update();       
  80.                
  81. /********更新遥控器数据********/               
  82.                 update_channels();
  83.                
  84. //                printf( "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\r\n",
  85. //                                channels[0],
  86. //                                channels[1],
  87. //                                channels[2],
  88. //                                channels[3],
  89. //                                channels[4],
  90. //                                channels[5],
  91. //                                channels[6],
  92. //                                channels[7],
  93. //                                channels[8],
  94. //                                channels[9],
  95. //                                channels[10],
  96. //                                channels[11]
  97. //                         );                                                                                       
  98. /********遥控器控制电机********/                       
  99.                 motor1=motor2=channels[0]/2+1000;       
  100.                 //printf("%d\r\n",channels[0]);
  101.                 Motor_PWM_Set(motor1,motor2);
  102. /********遥控器控制舵机********/               
  103. //                servo1=channels[1];
  104. //                servo2=channels[2];
  105. //    Servo_PWM_Set(servo1,servo2);

  107. Setpitch=(channels[1]-988)/30;
  108. if(channels[2]>1003 | channels[2]<1000){
  109. Setroll =(channels[2]-1002)/30;
  110. }

  112. /********测试舵机********/       
  113. //        Servo_PWM_Set(1050,950);

  115. //printf("%f,%f,%f,%f\n",Setroll,roll,Setpitch,pitch);
  116.         }        
  117. }

复制代码

Keil代码下载:
程序.7z (392.28 KB, 下载次数: 24)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩
回复

使用道具 举报

沙发
ID:336378 发表于 2023-8-4 12:19 | 只看该作者
这样子能飞起来吗？？。
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表