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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2087|回復: 0
打印 上一主題 下一主題
收起左側

stm32四軸飛控源程序

[復制鏈接]
跳轉到指定樓層
樓主
ID:347767 發(fā)表于 2018-9-25 22:33 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
編譯,下載,運行,連接飛控串口和FTDI串口,串口波特率500K,上位機打開高級收碼,在上位機飛控狀態(tài)標簽可以看到變化的傳感器數(shù)據(jù),3D顯示可以跟隨roll和pitch的變化而變化,因為沒有寫yaw的上傳,所以yaw保持零度...此時打開飛控波形按鈕,打開波形顯示頁面,并打開相應波形開關,1到3為加速度,4到6為陀螺儀,10和11為roll和pitch,就可以看到變化的波形.

單片機源程序如下:
  1. #include "uart1.h"
  2. #include "app/rc/rc.h"
  3. #include "bsp/MPU6050.h"
  4. #include "bsp/led.h"
  5. #include "app/imu/imu.h"
  6. #include "control.h"
  7. #include "bsp/bsp.h"
  8. #define BYTE0(dwTemp)       (*(char *)(&dwTemp))
  9. #define BYTE1(dwTemp)       (*((char *)(&dwTemp) + 1))
  10. #define BYTE2(dwTemp)       (*((char *)(&dwTemp) + 2))
  11. #define BYTE3(dwTemp)       (*((char *)(&dwTemp) + 3))
  12. u8 ARMED = 0;
  13. char flag_send;

  15. RC_GETDATA Rc_Get;//接收到的RC數(shù)據(jù),1000~2000
  16. float RC_Target_ROL=0,RC_Target_PIT=0,RC_Target_YAW=0;
  17. //void RC_FUN(void)
  18. //{
  19. ////判斷解鎖
  20. //        if(ARMED==0 && Rc_Get.THROTTLE < 1100 && Rc_Get.YAW <1100)
  21. //  {ARMED = 1;LED2_ON;}                //解鎖
  22. //        if(ARMED==1 && Rc_Get.THROTTLE <1100 && Rc_Get.YAW >1900)
  23. //        {ARMED = 0;LED2_OFF;}                //鎖定
  24. //}
  25. void BlueToothDeal(u8 buf_num)
  26. {
  27.         if(Rx_Buf[buf_num][1]==0x80)                //藍牙上位機指令
  28.         {               
  29.                 ARMED=1;
  30.                 if(Rx_Buf[buf_num][2]==0x81)flag_send=1;
  31.                 //16位數(shù)據(jù)  低位在前
  32.                                 Rc_Get.THROTTLE = Rx_Buf[buf_num][2]  ;Rc_Get.THROTTLE <<= 8;Rc_Get.THROTTLE += Rx_Buf[buf_num][3];
  33.                                 Rc_Get.YAW      = Rx_Buf[buf_num][4]  ;Rc_Get.YAW      <<= 8;Rc_Get.YAW      += Rx_Buf[buf_num][5];
  34.                                 Rc_Get.ROLL     = Rx_Buf[buf_num][6]  ;Rc_Get.ROLL     <<= 8;Rc_Get.ROLL     += Rx_Buf[buf_num][7];
  35.                                 Rc_Get.PITCH    = Rx_Buf[buf_num][8]  ;Rc_Get.PITCH    <<= 8;Rc_Get.PITCH    += Rx_Buf[buf_num][9];
  36.                                 Rc_Get.AUX1     = Rx_Buf[buf_num][10] ;Rc_Get.AUX1     <<= 8;Rc_Get.AUX1     += Rx_Buf[buf_num][11];
  37.                                 Rc_Get.AUX2     = Rx_Buf[buf_num][12] ;Rc_Get.AUX2     <<= 8;Rc_Get.AUX2     += Rx_Buf[buf_num][13];
  38.                                 Rc_Get.AUX3     = Rx_Buf[buf_num][14] ;Rc_Get.AUX3     <<= 8;Rc_Get.AUX3     += Rx_Buf[buf_num][15];
  39.                                 Rc_Get.AUX4     = Rx_Buf[buf_num][16] ;Rc_Get.AUX4     <<= 8;Rc_Get.AUX4     += Rx_Buf[buf_num][17];
  40.                                 Rc_Get.AUX5     = Rx_Buf[buf_num][18] ;Rc_Get.AUX5     <<= 8;Rc_Get.AUX5     += Rx_Buf[buf_num][19];
  41.                
  42.                         //RC_FUN();
  43.                
  44.                                 RC_Target_ROL = (Rc_Get.ROLL-1500)/30;
  45.                                 RC_Target_PIT = (Rc_Get.PITCH-1500)/30;
  46.                                 RC_Target_YAW = (Rc_Get.YAW-1500)/30;
  47.                                 LED2_ONOFF();
  48.         }
  49.         else if(Rx_Buf[buf_num][1]==0x77)        //加鎖解鎖
  50.         {
  51.                 Rc_Get.THROTTLE = Rx_Buf[buf_num][2]  ;Rc_Get.THROTTLE <<= 8;Rc_Get.THROTTLE += Rx_Buf[buf_num][3];
  52.                 Rc_Get.YAW      = Rx_Buf[buf_num][4]  ;Rc_Get.YAW      <<= 8;Rc_Get.YAW      += Rx_Buf[buf_num][5];
  53.                         //判斷解鎖
  54.                 if(ARMED==0 && Rc_Get.THROTTLE < 1100 && Rc_Get.YAW <1100)
  55.                 {ARMED = 1;LED2_ON;}                //解鎖
  56.                 if(ARMED==1 && Rc_Get.THROTTLE <1100 && Rc_Get.YAW >1900)
  57.                 {ARMED = 0;LED2_OFF;}                //鎖定
  58.         }
  59.         else if(Rx_Buf[buf_num][1]==0x70)        //保存PID數(shù)據(jù)
  60.         {
  61.                         PID_ROL.P = (float)((vs16)(Rx_Buf[buf_num][2]<<8) |Rx_Buf[buf_num][3])/100;
  62.                         PID_ROL.I = (float)((vs16)(Rx_Buf[buf_num][4]<<8) |Rx_Buf[buf_num][5])/100;
  63.                         PID_ROL.D = (float)((vs16)(Rx_Buf[buf_num][6]<<8) |Rx_Buf[buf_num][7]) /10000;
  64.                         PID_PIT.P = (float)((vs16)(Rx_Buf[buf_num][8]<<8) |Rx_Buf[buf_num][9])/100;
  65.                         PID_PIT.I = (float)((vs16)(Rx_Buf[buf_num][10]<<8)|Rx_Buf[buf_num][11])/100;
  66.                         PID_PIT.D = (float)((vs16)(Rx_Buf[buf_num][12]<<8)|Rx_Buf[buf_num][13])/10000;
  67.                         PID_YAW.P = (float)((vs16)(Rx_Buf[buf_num][14]<<8)|Rx_Buf[buf_num][15])/100;
  68.                         PID_YAW.I = (float)((vs16)(Rx_Buf[buf_num][16]<<8)|Rx_Buf[buf_num][17])/100;
  69.                         PID_YAW.D = (float)((vs16)(Rx_Buf[buf_num][18]<<8)|Rx_Buf[buf_num][19])/10000;
  70.                         EE_SAVE_PID();       
  71.                         Uart1_Put_Char(0x71);//幀頭       
  72.                         Uart1_Put_Char(0x88);//幀頭
  73.                
  74.         }
  75.         else if(Rx_Buf[buf_num][1]==0x71)                //發(fā)送PID數(shù)據(jù)給上位機
  76.         {
  77.                 //反饋數(shù)據(jù)
  78.                 EE_READ_PID_Send();
  79.         }
  80. }
  81. void Uart_DataAnl(u8 buf_num)                //串口緩存數(shù)據(jù)分析
  82. {
  83. if(Rx_Buf[buf_num][1]==0x8A)                //串口收到的是上位機的遙控數(shù)據(jù)
  84.         {
  85.                 Uart1_Put_Char(0x30+buf_num);
  86.         }
  87. }
  88. void BlueToothCheckEvent(void)
  89. {
  90.         //0-9位 校驗和
  91.         if(Rx_Ok0)
  92.         {
  93.                 Rx_Ok0 = 0;
  94. //                u8 sum = 0;
  95. //                for(int i=0;i<20;i++)
  96. //                        sum += Rx_Buf[0][i];
  97. //                if(sum == Rx_Buf[0][20])                //和校驗通過
  98. //                {
  99.                         BlueToothDeal(0);
  100. //                }
  101.                
  102.         }
  103.         if(Rx_Ok1)
  104.         {
  105.                 Rx_Ok1 = 0;
  106. //                u8 sum = 0;
  107. //                for(int i=0;i<20;i++)
  108. //                        sum += Rx_Buf[1][i];
  109. //                if(sum == Rx_Buf[1][20])                //和校驗通過
  110. //                {
  111.                         BlueToothDeal(1);
  112. //                }
  113.         }       
  114. }
  115. void Uart_CheckEvent(void)
  116. {
  117.         if(Rx_Ok0)
  118.         {
  119.                 Rx_Ok0 = 0;
  120.                 u8 sum = 0;
  121.                 for(int i=0;i<31;i++)
  122.                         sum += Rx_Buf[0][i];
  123.                 if(sum == Rx_Buf[0][31])                //和校驗通過
  124.                 {
  125.                         Uart_DataAnl(0);
  126.                 }
  127.         }
  128.         if(Rx_Ok1)
  129.         {
  130.                 Rx_Ok1 = 0;
  131.                 u8 sum = 0;
  132.                 for(int i=0;i<31;i++)
  133.                         sum += Rx_Buf[1][i];
  134.                 if(sum == Rx_Buf[1][31])                //和校驗通過
  135.                 {
  136.                         Uart_DataAnl(1);
  137.                 }
  138.         }
  139. }

  141. void Uart1_Send_Buf(u8 *buf,u8 len)                //發(fā)送buf,長度len,返回字節(jié)和sum
  142. {
  143.         while(len)
  144.         {
  145.                 Uart1_Put_Char(*buf);
  146.                 buf++;
  147.                 len--;
  148.         }
  149. }
  150. void Uart1_Send_RCdata(void)
  151. {
  152.         uint8_t sum = 0;
  153.         sum += Uart1_Put_Char(0x88);
  154.         sum += Uart1_Put_Char(0xAE);
  155.         sum += Uart1_Put_Char(28);
  156.         sum += Uart1_Put_Int16(Rc_Get.THROTTLE);
  157.         sum += Uart1_Put_Int16(Rc_Get.YAW);
  158.         sum += Uart1_Put_Int16(Rc_Get.ROLL);
  159.         sum += Uart1_Put_Int16(Rc_Get.PITCH);
  160.         sum += Uart1_Put_Int16(Rc_Get.AUX1);
  161.         sum += Uart1_Put_Int16(Rc_Get.AUX2);
  162.         sum += Uart1_Put_Int16(Rc_Get.AUX3);
  163.         sum += Uart1_Put_Int16(Rc_Get.AUX4);
  164.         sum += Uart1_Put_Int16(0);
  165.         sum += Uart1_Put_Int16(0);
  166.         sum += Uart1_Put_Int16(0);
  167.         sum += Uart1_Put_Int16(0);
  168.         sum += Uart1_Put_Int16(0);
  169.         sum += Uart1_Put_Int16(0);
  170.         Uart1_Put_Char(sum);
  171. }

  173. void PC_Debug_Show(u8 num,u16 sta)//sta=0 熄滅 sta=1 點亮  >1 取反
  174. {
  175.         static uint8_t led_s[6] = {0,0,0,0,0,0};
  176.         uint8_t sum = 0;
  177.         if(0<num && num<7)
  178.         {
  179.                 sum += Uart1_Put_Char(0x88);
  180.                 sum += Uart1_Put_Char(0xAD);
  181.                 sum += Uart1_Put_Char(0x02);
  182.                 sum += Uart1_Put_Char(num);
  183.                 if(sta==0)
  184.                         sum += Uart1_Put_Char(0x00);
  185.                 else if(sta==1)
  186.                         sum += Uart1_Put_Char(0x01);
  187.                 else
  188.                 {
  189.                         if(led_s[num])        led_s[num] = 0;
  190.                         else                         led_s[num] = 1;
  191.                         sum += Uart1_Put_Char(led_s[num]);
  192.                 }
  193.                 Uart1_Put_Char(sum);
  194.         }
  195.         else if(6<num && num<13)
  196.         {
  197.                 sum += Uart1_Put_Char(0x88);
  198.                 sum += Uart1_Put_Char(0xAD);
  199.                 sum += Uart1_Put_Char(0x03);
  200.                 sum += Uart1_Put_Char(num);
  201.                 sum += Uart1_Put_Int16(sta);
  202.                 Uart1_Put_Char(sum);
  203.         }
  204. }
  205. void Uart1_Send_AF(void)
  206. {
  207.         uint8_t sum = 0;
  208.         uint16_t _temp;
  209.         sum += Uart1_Put_Char(0x88);
  210.         sum += Uart1_Put_Char(0xAF);
  211.         sum += Uart1_Put_Char(0x1c);
  212.         sum += Uart1_Put_Char(BYTE1(MPU6050_ACC_LAST.X));
  213.         sum += Uart1_Put_Char(BYTE0(MPU6050_ACC_LAST.X));
  214.         sum += Uart1_Put_Char(BYTE1(MPU6050_ACC_LAST.Y));
  215.         sum += Uart1_Put_Char(BYTE0(MPU6050_ACC_LAST.Y));
  216.         sum += Uart1_Put_Char(BYTE1(MPU6050_ACC_LAST.Z));
  217.         sum += Uart1_Put_Char(BYTE0(MPU6050_ACC_LAST.Z));
  218.         sum += Uart1_Put_Char(BYTE1(MPU6050_GYRO_LAST.X));
  219.         sum += Uart1_Put_Char(BYTE0(MPU6050_GYRO_LAST.X));
  220.         sum += Uart1_Put_Char(BYTE1(MPU6050_GYRO_LAST.Y));
  221.         sum += Uart1_Put_Char(BYTE0(MPU6050_GYRO_LAST.Y));
  222.         sum += Uart1_Put_Char(BYTE1(MPU6050_GYRO_LAST.Z));
  223.         sum += Uart1_Put_Char(BYTE0(MPU6050_GYRO_LAST.Z));
  224.         sum += Uart1_Put_Char(0);
  225.         sum += Uart1_Put_Char(0);
  226.         sum += Uart1_Put_Char(0);
  227.         sum += Uart1_Put_Char(0);
  228.         sum += Uart1_Put_Char(0);
  229.         sum += Uart1_Put_Char(0);
  230.        
  231.         _temp = (int)(Q_ANGLE.X*100);
  232.         sum += Uart1_Put_Char(BYTE1(_temp));
  233.         sum += Uart1_Put_Char(BYTE0(_temp));
  234.         _temp = (int)(Q_ANGLE.Y*100);
  235.         sum += Uart1_Put_Char(BYTE1(_temp));
  236.         sum += Uart1_Put_Char(BYTE0(_temp));
  237.   _temp = (int)(Q_ANGLE.Z*100);
  238.         sum += Uart1_Put_Char(BYTE1(_temp));
  239.         sum += Uart1_Put_Char(BYTE0(_temp));
  240.        
  241.         //sum += Uart1_Put_Char(0);
  242.   //sum += Uart1_Put_Char(0);
  243.         sum += Uart1_Put_Char(0);
  244.         sum += Uart1_Put_Char(0);
  245.         sum += Uart1_Put_Char(0);
  246.         sum += Uart1_Put_Char(0);
  247.         Uart1_Put_Char(sum);
  248. }

  250. void Uart1_Send_AE(void)
  251. {
  252.         uint8_t sum=0;
  253.         uint16_t _temp;
  254.         sum = 0;       
  255.         sum =  Uart1_Put_Char(0x88);
  256.         sum += Uart1_Put_Char(0xAE);
  257.         sum += Uart1_Put_Char(0x1c);
  258.         sum += Uart1_Put_Char(0);
  259.         sum += Uart1_Put_Char(0);
  260.         sum += Uart1_Put_Char(0);
  261.         sum += Uart1_Put_Char(0);
  262.         sum += Uart1_Put_Char(0);
  263.         sum += Uart1_Put_Char(0);
  264.         sum += Uart1_Put_Char(0);
  265. ……………………

  267. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
bee_source.rar (386.55 KB, 下載次數(shù): 13)


分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網(wǎng)

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 久久亚洲一区 | 亚洲精品视频在线播放 | 亚洲精品自在在线观看 | 精品福利av导航 | 国产日韩在线观看一区 | va精品| 狠狠干夜夜草 | 亚洲国产精品人人爽夜夜爽 | 久久久久久久久久久久久久av | 国产高清精品在线 | 欧美日本韩国一区二区 | 国产高清视频在线 | 亚洲综合视频 | 波波电影院一区二区三区 | 欧美一区二区在线播放 | 久久激情五月丁香伊人 | 亚洲欧美一区二区三区国产精品 | 亚洲成人av在线播放 | 夜色www国产精品资源站 | 国产一区二区三区视频 | 亚洲小视频在线播放 | 欧美日韩国产三级 | www亚洲精品 | 免费一级大片 | 久久91精品 | 国产精品久久久久久久久久久免费看 | 久久久久久久久久久久久91 | 亚洲午夜电影 | 国产在线观看一区二区 | 欧美在线视频网 | 国产精品区二区三区日本 | 久久在线 | 久久久久国产精品 | 在线看亚洲| 精品福利在线 | 亚洲第一色站 | 在线一区| 欧美亚洲国产一区二区三区 | www.一级片 | 天天色图 | 久久精品中文字幕 |