亚洲春色中文字幕久久久-三上亚,一吻二脱三床四吻胸,国产真实伦对白视频全集,在线毛片观看,精品成品入口黄网,国产毛aⅴ片久久久,亚洲AV色香蕉一区二区三区老师,萧皇后A级艳片,色情日本视频更新,99久久亚洲精品日本无码

標題: STC51單片機四軸飛控開源項目原理圖與源碼資料分享 [打印本頁]
作者: openswan    時間: 2017-11-26 11:19
標題: STC51單片機四軸飛控開源項目原理圖與源碼資料分享
四軸飛控-STC8A8K64S4A12-LQFP44-PPM-V10，來源于STC發布，按需取用
控制信號排針要靠在一起布線成3排針3*9*2.54
P1~P4對應接收機的俯仰、橫滾、油門、航向PPM信號。M1~M4輸出到4個電調的信號。P5備用。
四個電機安排順序如下：

串口1: 下載、調試、控制信號輸入.
串口2: 備用為GPS接口或數傳接口.


原理圖：



飛控的stc單片機程序源碼：
  1. /* 本程序經過測試完全正常, 不提供電話技術支持, 如不能理解, 請自行補充相關基礎.  */

  3. /***  特別注意: 下載時選擇內部時鐘24MHZ, 設置用戶EEPROM大小為2K或以上.  ****/

  5. /*********************************************
  6.   四軸飛控-V10.C

  8. 使用遙控接收器型號: MC6B六通道2.4G 100mW.

  10. 四軸上電待機：上電后，航燈不亮，接收機LED閃爍，此時打開遙控器，將左右油門下拉到最小，接收機收到信號LED常亮，
  11.               表示RF通訊已連接。此時蜂鳴器"嗶"一聲，航燈閃爍，表示待機模式。

  13. 四軸啟動：將遙控器左右操縱桿掰成下內八，啟動四軸，四軸"嗶"一聲，4個螺旋槳開始低速旋轉，航燈常亮。
  14.           此后提升油門，就可以加速螺旋槳，直到起飛。

  16. 四軸飛行：起飛后，可以操縱右手的俯仰、橫滾操縱桿，實現前后左右或任意方向的飛行。
  17.           左手油門桿左掰是航向逆時針轉，右掰是航向順時鐘轉。

  19. 四軸下降停止：收油門，四軸逐漸下降到地面，然后兩操縱桿掰成下外八，停止四軸，重新處于待機模式。

  21. 四軸水平校準：將四軸放置于水平地面，處于待機模式，然后兩操縱桿掰成上內八，四軸"嗶"一聲進入校準，完成后"嗶嗶"兩聲完成校準。

  23. 四軸取消水平校準：將四軸放置于水平地面，處于待機模式，然后兩操縱桿掰成上外八，四軸"嗶"一聲取消校準。取消水平校準或未進行水平校準過的四軸，起飛時即使無風也可能會有明顯漂移。

  25. 電池低壓報警：當電池低壓時，蜂鳴器"嗶嗶"報警，同時航燈閃爍，此時請盡快回航降落。

  27. 無遙控信號異常：當四軸在空中突然收不到遙控信號時，四軸蜂鳴器發出"嗶嗶嗶"報警，同時航燈閃爍，四軸保持水平，逐漸自動減小油門降落。

  29. ***********************************************/

  31. #define                Baudrate1                        115200UL
  32. #define                TX1_LENGTH        128
  33. #define                RX1_LENGTH        128


  36. #include "config.h"
  37. #include "STC8xxx_PWM.H"
  38. #include "MPU6050.H"
  39. #include "AD.H"       
  40. #include "EEPROM.H"
  41. #include "PCA.h"
  42. #include <math.H>

  44. sbit        P_Light  = P5^4;        //航燈
  45. sbit        P_BUZZER = P5^5;        //蜂鳴器


  48. int                xdata g_x=0,g_y=0,g_z=0;                                        //陀螺儀矯正參數
  49. float        xdata a_x=0,a_y=0;                                                        //角度矯正參數
  50. float        data  AngleX=0,AngleY=0;                                        //四元數解算出的歐拉角
  51. float        xdata Angle_gx=0,Angle_gy=0,Angle_gz=0;                //由角速度計算的角速率(角度制)
  52. float        xdata Angle_ax=0,Angle_ay=0,Angle_az=0;                //由加速度計算的加速度(弧度制)
  53. float        xdata Ax=0,Ay=0,Az=0;                                                //加入遙控器控制量后的角度   
  54. float        data PID_x=0,PID_y=0,PID_z=0;                                //PID最終輸出量
  55. int                data  speed0=0,speed1=0,speed2=0,speed3=0;        //電機速度參數
  56. int                data  PWM0=0,PWM1=0,PWM2=0,PWM3=0;//,PWM4=0,PWM5=0;                        //加載至PWM模塊的參數

  58. int                int_tmp;
  59. u8                YM=0,FRX=128,FRY=128,FRZ=128;                                //4通道遙控信號.
  60. u8                xdata        tp[16];                //讀MP6050緩沖


  63. //****************姿態處理和PID*********************************************

  65. float xdata Out_PID_X=0,Last_Angle_gx=0;                                        //外環PI輸出量  上一次陀螺儀數據
  66. float xdata ERRORX_Out=0,ERRORX_In=0;                        //外環P  外環I  外環誤差積分
  67. float xdata Out_PID_Y=0,Last_Angle_gy=0;
  68. float xdata ERRORY_Out=0,ERRORY_In=0;            //規則1:內外環P乘積等于10.5

  70. float xdata Last_Ax=0,Last_Ay=0,Last_Az=0;


  73. /******************************************************************************/
  74. #define        Out_XP        6.65f        //ADC0        外環P        V1 / 10
  75. #define        Out_XI        0.0074f        //ADC4        外環I        V2 / 10000
  76. #define        Out_XD        6.0f        //ADC5        外環D        V3 / 10

  78. #define        In_XP        0.8275f        //ADC6        內環P        V4 / 100
  79. #define        In_XI        0.0074f        //ADC4        內環I        V2 / 10000
  80. #define        In_XD        6.0f        //ADC5        內環D        V3 / 10


  83. #define        Out_YP        Out_XP
  84. #define        Out_YI        Out_XI
  85. #define        Out_YD        Out_XD

  87. #define        In_YP        In_XP
  88. #define        In_YI        In_XI
  89. #define        In_YD        In_XD


  92. #define        ZP        5.0f
  93. #define        ZI        0.1f
  94. #define        ZD        4.0f        //自旋控制的P D
  95. float Z_integral=0;//Z軸積分

  97. #define        ERR_MAX        500
  98. //======================================================================


  101. u8        data YM_LostCnt=0, Lost16S; //上一次RxBuf[0]數據(RxBuf[0]數據在不斷變動的)   狀態標識
  102. u8        SW2_tmp;


  105. //======================================================================
  106. bit        B_8ms;        //8ms標志

  108. bit        B_rtn_ADC0;        //請求返回信息
  109. bit        B_BAT_LOW;        //低電壓標志
  110. u8        xdata cnt_ms;                //時間計數


  113. u8                xdata UART1_cmd=0;        //串口命令
  114. u8                xdata TX1_Read=0;        //發送讀指針
  115. u8                xdata TX1_Write=0;        //發送寫指針
  116. u8                xdata TX1_cnt=0;        //發送計數
  117. u8                 xdata TX1_Buffer[TX1_LENGTH];        //發送緩沖
  118. bit                B_TX1_Busy;                        //發送忙標志
  119. u8                 xdata RX1_Cnt,RX1_Timer;
  120. u8                 xdata RX1_Buffer[RX1_LENGTH];
  121. bit         B_RX1_OK;


  124. u8                xdata Cal_Setp=0;                        //校準步驟
  125. u8                xdata Cal_cnt=0;                        //校準平均值計數
  126. int                xdata x_sum,y_sum,z_sum;        //校準累加和
  127. float        xdata float_x_sum,float_y_sum;        //校準累加和

  129. u8        xdata BuzzerOnTime,BuzzerOffTime,BuzzerRepeat,BuzzerOnCnt,BuzzerOffCnt;
  130. u8        xdata cnt_100ms;


  133. /* =================== PPM接收相關變量 ========================== */
  134. u16        xdata CCAP0_RiseTime;                //捕捉到的上升沿時刻
  135. u8        xdata PPM1_Rise_TimeOut;        //高電平限時
  136. u8        xdata PPM1_Rx_TimerOut;                //接收超時計數
  137. u8        xdata PPM1_RxCnt;                        //接收次數計數
  138. u16        xdata PPM1_Cap;                                //捕捉到的PPM脈沖寬度
  139. bit        B_PPM1_OK;                                        //接收到一個PPM脈沖寬度

  141. u16        xdata CCAP1_RiseTime;
  142. u8        xdata PPM2_Rise_TimeOut;        //高電平限時
  143. u8        xdata PPM2_Rx_TimerOut;
  144. u8        xdata PPM2_RxCnt;
  145. u16        xdata PPM2_Cap;
  146. bit        B_PPM2_OK;

  148. u16        xdata CCAP2_RiseTime;
  149. u8        xdata PPM3_Rise_TimeOut;        //高電平限時
  150. u8        xdata PPM3_Rx_TimerOut;
  151. u8        xdata PPM3_RxCnt;
  152. u16        xdata PPM3_Cap;
  153. bit        B_PPM3_OK;

  155. u16        xdata CCAP3_RiseTime;
  156. u8        xdata PPM4_Rise_TimeOut;        //高電平限時
  157. u8        xdata PPM4_Rx_TimerOut;
  158. u8        xdata PPM4_RxCnt;
  159. u16        xdata PPM4_Cap;
  160. bit        B_PPM4_OK;

  162. u16        xdata CCAP_FallTime;

  164. u8        PPM1,PPM2,PPM3,PPM4;
  165. bit        B_Start;
  166. u8        cnt_start;

  168. /* ============================================= */


  171. void        UART1_config(void);
  172. void         PrintString1(u8 *puts);        //發送一個字符串
  173. void        TX1_write2buff(u8 dat);        //寫入發送緩沖，指針+1
  174. void        TX1_int_value(int i);
  175. void        delay_ms(u8 ms);
  176. void        Return_Message(void);
  177. u16         MODBUS_CRC16(u8 *p,u8 n);        //input:        *p--->First Data Address,n----->Data Number,        return:        CRC16
  178. void        PCA_config(void);
  179. void         Timer0_Config(void);
  180. void         Timer1_Config(void);
  181. void        return_TTMx(u8 id,PPMx);
  182. void         Timer0_Config(void);
  183. u16         MODBUS_CRC16(u8 *p,u8 n);        //input:        *p--->First Data Address,n----->Data Number,        return:        CRC16

  185. extern xdata u16        adc0;
  186. extern xdata int        Battery;


  189. //*********************************************************************
  190. //****************角度計算*********************************************
  191. //*********************************************************************
  192. #define        pi                3.14159265f                           
  193. #define        Kp                0.8f                        
  194. #define        Ki                0.001f                        
  195. #define        halfT        0.004f           

  197. float idata q0=1,q1=0,q2=0,q3=0;   
  198. float idata exInt=0,eyInt=0,ezInt=0;  


  201. void IMUupdate(float gx, float gy, float gz, float ax, float ay, float az)
  202. {
  203.         float data norm;
  204.         float idata vx, vy, vz;
  205.         float idata ex, ey, ez;

  207.         norm = sqrt(ax*ax + ay*ay + az*az);        //把加速度計的三維向量轉成單維向量   
  208.         ax = ax / norm;
  209.         ay = ay / norm;
  210.         az = az / norm;

  212.                 //        下面是把四元數換算成《方向余弦矩陣》中的第三列的三個元素。
  213.                 //        根據余弦矩陣和歐拉角的定義，地理坐標系的重力向量，轉到機體坐標系，正好是這三個元素
  214.                 //        所以這里的vx vy vz，其實就是當前的歐拉角（即四元數）的機體坐標參照系上，換算出來的
  215.                 //        重力單位向量。
  216.         vx = 2*(q1*q3 - q0*q2);
  217.         vy = 2*(q0*q1 + q2*q3);
  218.         vz = q0*q0 - q1*q1 - q2*q2 + q3*q3 ;

  220.         ex = (ay*vz - az*vy) ;
  221.         ey = (az*vx - ax*vz) ;
  222.         ez = (ax*vy - ay*vx) ;

  224.         exInt = exInt + ex * Ki;
  225.         eyInt = eyInt + ey * Ki;
  226.         ezInt = ezInt + ez * Ki;

  228.         gx = gx + Kp*ex + exInt;
  229.         gy = gy + Kp*ey + eyInt;
  230.         gz = gz + Kp*ez + ezInt;

  232.         q0 = q0 + (-q1*gx - q2*gy - q3*gz) * halfT;
  233.         q1 = q1 + ( q0*gx + q2*gz - q3*gy) * halfT;
  234.         q2 = q2 + ( q0*gy - q1*gz + q3*gx) * halfT;
  235.         q3 = q3 + ( q0*gz + q1*gy - q2*gx) * halfT;

  237.         norm = sqrt(q0*q0 + q1*q1 + q2*q2 + q3*q3);
  238.         q0 = q0 / norm;
  239.         q1 = q1 / norm;
  240.         q2 = q2 / norm;
  241.         q3 = q3 / norm;

  243.         AngleX = asin(2*(q0*q2 - q1*q3 )) * 57.2957795f; // 俯仰   換算成度
  244.         AngleY = asin(2*(q0*q1 + q2*q3 )) * 57.2957795f; // 橫滾
  245. }



  249. //****************姿態計算*********************************************
  250. void PWM_int (void) interrupt         22        //PWM中斷函數
  251. {
  252.         PWMCFG = 0;        //CBIF;        //清除中斷標志

  254.         B_8ms = 1;

  256. //======================== 超時溢出處理 ==============================================
  257.         PPM1_Rise_TimeOut++;        //高電平限時
  258.         PPM2_Rise_TimeOut++;        //高電平限時
  259.         PPM3_Rise_TimeOut++;        //高電平限時
  260.         PPM4_Rise_TimeOut++;        //高電平限時

  262.         if(--PPM1_Rx_TimerOut == 0)                //超過100ms收不到信號
  263.         {
  264.                 PPM1_RxCnt = 0;                        //一旦出現溢出, 則開始的n個脈沖無效
  265.                 PPM1 = 128;;                        //默認中點
  266.         }
  267.         if(--PPM2_Rx_TimerOut == 0)                //超過100ms收不到信號
  268.         {
  269.                 PPM2_RxCnt = 0;                        //一旦出現溢出, 則開始的n個脈沖無效
  270.                 PPM2 = 128;;                        //默認中點
  271.         }
  272.         if(--PPM3_Rx_TimerOut == 0)                //超過200ms收不到信號
  273.         {
  274.                 PPM3_RxCnt = 0;                        //一旦出現溢出, 則開始的n個脈沖無效
  275.         }
  276.         if(--PPM4_Rx_TimerOut == 0)                //超過100ms收不到信號
  277.         {
  278.                 PPM4_RxCnt = 0;                        //一旦出現溢出, 則開始的n個脈沖無效
  279.                 PPM4 = 128;                                //默認中點
  280.         }
  281. //======================================================================

  283.         if(++YM_LostCnt >= 250)                //失聯2秒后
  284.         {
  285.                 YM_LostCnt = 200;                //重復0.4秒，失控保護
  286.                 if(PPM3 > 80)        PPM3--;
  287.                 else if(++Lost16S >= 40)
  288.                 {
  289.                         Lost16S = 250;
  290.                         PPM3 = 0;
  291.                         B_Start = 0;
  292.                 }
  293.         }
  294.         if(YM_LostCnt  >= 25)        //失聯200ms
  295.         {
  296.                 PPM1 = 128;
  297.                 PPM2 = 128;                //俯仰 橫滾 航向均歸0
  298.                 PPM4 = 128;
  299.         }

  301.         FRX = PPM1;
  302.         FRY = PPM2;
  303.         YM  = PPM3;        //油門
  304.         FRZ = PPM4;
  305.        

  307. //********************************************************************************************
  308.         Read_MPU6050(tp);        //680us

  310.         Angle_ax = ((float)(((int *)&tp)[0])) / 8192.0;        //加速度處理        結果單位是 +- g
  311.         Angle_ay = ((float)(((int *)&tp)[1])) / 8192.0;        //轉換關系        8192 LSB/g, 1g對應讀數8192
  312.         Angle_az = ((float)(((int *)&tp)[2])) / 8192.0;        //加速度量程 +-4g/S
  313.         Last_Angle_gx = Angle_gx;                //儲存上一次角速度數據
  314.         Last_Angle_gy = Angle_gy;
  315.         Angle_gx = ((float)(((int *)&tp)[4] - g_x)) / 65.5;        //陀螺儀處理        結果單位是 +-度
  316.         Angle_gy = ((float)(((int *)&tp)[5] - g_y)) / 65.5;        //陀螺儀量程 +-500度/S, 1度/秒 對應讀數 65.536
  317.         Angle_gz = ((float)(((int *)&tp)[6] - g_z)) / 65.5;        //轉換關系65.5 LSB/度

  319.         IMUupdate(Angle_gx*0.0174533f, Angle_gy*0.0174533f, Angle_gz*0.0174533f, Angle_ax,Angle_ay,Angle_az);

  321. //**********************************X軸指向************************************************
  322.         Ax  = AngleX - a_x - ((float)FRX - 128) / 4.0;                //角度控制量加載至角度

  324.         if(YM > 35)        ERRORX_Out += Ax,        ERRORX_Out += Ax,        ERRORX_Out += Ax;        //外環積分(油門小于某個值時不積分)
  325.         else                ERRORX_Out = 0; //油門小于定值時清除積分值
  326.                  if(ERRORX_Out >  1500)        ERRORX_Out =  1500;
  327.         else if(ERRORX_Out < -1500)        ERRORX_Out = -1500;        //積分限幅

  329.         Out_PID_X = Ax*Out_XP + ERRORX_Out*Out_XI + (Ax-Last_Ax)*Out_XD;        //外環PI
  330.         Last_Ax = Ax;
  331.        
  332.         if(YM > 35)        ERRORX_In += (Angle_gy - Out_PID_X);        //內環積分(油門小于某個值時不積分)
  333.         else                ERRORX_In = 0;        //油門小于定值時清除積分值
  334.                  if(ERRORX_In >  500)        ERRORX_In =  500;
  335.         else if(ERRORX_In < -500)        ERRORX_In = -500;        //積分限幅

  337.         PID_x = (Angle_gy + Out_PID_X) * In_XP + ERRORX_In * In_XI + (Angle_gy - Last_Angle_gy) * In_XD;        //內環PID
  338.         if(PID_x >  500)        PID_x =  500;        //輸出量限幅
  339.         if(PID_x < -500)        PID_x = -500;

  341. //**************Y軸指向**************************************************
  342.         Ay  = AngleY - a_y + ((float)FRY - 128) / 4.0;                //角度控制量加載至角度
  343.        
  344.         if(YM > 35)        ERRORY_Out += Ay,        ERRORY_Out += Ay,        ERRORY_Out += Ay;        //外環積分(油門小于某個值時不積分)
  345.         else                ERRORY_Out = 0; //油門小于定值時清除積分值
  346.                  if(ERRORY_Out >  1500)        ERRORY_Out =  1500;
  347.         else if(ERRORY_Out < -1500)        ERRORY_Out = -1500;        //積分限幅
  348.        
  349.         Out_PID_Y = Ay * Out_YP + ERRORY_Out * Out_YI + (Ay-Last_Ay)*Out_YD;        //外環PID
  350.         Last_Ay = Ay;

  352.         if(YM > 35)        ERRORY_In += (Angle_gx - Out_PID_Y);  //內環積分(油門小于某個值時不積分)
  353.         else                ERRORY_In = 0; //油門小于定值時清除積分值
  354.                  if(ERRORY_In >  500)        ERRORY_In =  500;
  355.         else if(ERRORY_In < -500)        ERRORY_In = -500;        //積分限幅
  356.        
  357.         PID_y = (Angle_gx + Out_PID_Y) * In_YP + ERRORY_In * In_YI + (Angle_gx - Last_Angle_gx) * In_YD;        //內環PID
  358.        
  359.         if(PID_y > 500)        PID_y =  500;        //輸出量限幅
  360.         if(PID_y <-500)        PID_y = -500;

  362. //**************Z軸指向(Z軸隨便啦，自旋控制沒必要上串級PID)*****************************       
  363.         Az = Angle_gz - ((float)FRZ - 128);
  364.        
  365.         if(YM > 35)        Z_integral += Az;        //Z軸積分
  366.         else                Z_integral = 0;                //油門小于40積分清零
  367.                  if(Z_integral >  500.0f)        Z_integral =  500.0f;        //積分限幅
  368.         else if(Z_integral < -500.0f)        Z_integral = -500.0f;        //積分限幅

  370.         PID_z = Az * ZP + Z_integral * ZI + (Az - Last_Az) * ZD;
  371.         Last_Az = Az;
  372.         if(PID_z >  200)        PID_z =  200;        //輸出量限幅
  373.         if(PID_z < -200)        PID_z = -200;

  375.         speed0 = (int)(  PID_x + PID_y + PID_z);        //M1改為逆時針
  376.         speed1 = (int)(  PID_x - PID_y - PID_z);
  377.         speed2 = (int)( -PID_x - PID_y + PID_z);
  378.         speed3 = (int)( -PID_x + PID_y - PID_z);

  380. //**************將速度參數加載至PWM模塊*************************************************       
  381.        
  382.         if(YM < 10)        PWM0 = 1000, PWM1 = 1000, PWM2 = 1000, PWM3 = 1000;
  383.         else if(YM < 35)        PWM0 = 860, PWM1 = 860, PWM2 = 860, PWM3 = 860;
  384.         else
  385.         {
  386.                 int_tmp = 1000 - (int)YM * 4;

  388.                 PWM0 = int_tmp - speed0;

  390.                          if(PWM0 > 1000)        PWM0 = 1000;    //速度參數控制，防止超過PWM參數范圍0-1000
  391.                 else if(PWM0 < 10)                PWM0 = 10;

  393.                 PWM1 = int_tmp - speed1;

  395.                          if(PWM1 > 1000)        PWM1 = 1000;
  396.                 else if(PWM1 < 10)                PWM1 = 10;

  398.                 PWM2 = int_tmp - speed2;

  400.                          if(PWM2 > 1000)        PWM2 = 1000;
  401.                 else if(PWM2 < 10)                PWM2 = 10;

  403.                 PWM3 = int_tmp - speed3;

  405.                          if(PWM3 > 1000)        PWM3 = 1000;
  406.                 else if(PWM3 < 10)                PWM3 = 10;
  407.         }

  409.         SW2_tmp = P_SW2;        //保存SW2設置
  410.         EAXSFR();        //訪問XFR
  411.         PWM0T2 = (u16)(PWM0 * 2);
  412.         PWM1T2 = (u16)(PWM1 * 2);
  413.         PWM2T2 = (u16)(PWM2 * 2);
  414.         PWM3T2 = (u16)(PWM3 * 2);       
  415.         P_SW2  = SW2_tmp;        //恢復SW2設置

  417. }


  420. /********************** 蜂鳴函數 ************************/
  421. void        beep(void)        //100ms調用
  422. {
  423.         if(BuzzerRepeat > 0)        //蜂鳴器處理, 重復次數不為0，則蜂鳴器要發聲
  424.         {
  425.                 if((BuzzerOnCnt == 0) && (BuzzerOffCnt == 0))        //On和OFF都為0，則開始裝載On和Off的時間
  426.                 {
  427.                         P_BUZZER = 1;                        //允許蜂鳴
  428.                         BuzzerOnCnt  = BuzzerOnTime;        //裝載on計數
  429.                         BuzzerOffCnt = BuzzerOffTime;        //裝載off計數
  430.                 }
  431.                 else if(BuzzerOnCnt  > 0)        {if(--BuzzerOnCnt == 0)        P_BUZZER = 0;}        //On的時間
  432.                 else if(BuzzerOffCnt > 0)        //Off的時間
  433.                 {
  434.                         if(--BuzzerOffCnt == 0)        BuzzerRepeat--;
  435.                 }
  436.         }
  437.         else        P_BUZZER = 0;
  438. }

  440. void        SetBuzzer(u8 on,u8 off,u8 rep)        // rep: 重復次數, on: on的時間, off: off的時間
  441. {
  442.         BuzzerRepeat = rep;
  443.         BuzzerOnTime  = on;
  444.         BuzzerOffTime = off;
  445.         if(BuzzerOnTime  == 0)        BuzzerOnTime  = 1;
  446.         if(BuzzerOffTime == 0)        BuzzerOffTime = 1;
  447.         if(BuzzerRepeat == 1)        BuzzerOffTime = 1;
  448.         BuzzerOnCnt = 0,        BuzzerOffCnt = 0;
  449. }

  451. // ===================== 自動校準序列 =====================
  452. void        AutoCal(void)
  453. {
  454.         if(PPM3 < 40)        //停止時才允許校準
  455.         {
  456.                 if(Cal_Setp == 1)        //進入校準序列
  457.                 {
  458.                         x_sum = 0;        y_sum = 0;        z_sum = 0;
  459.                         Cal_cnt  = 0;
  460.                         Cal_Setp = 2;
  461.                 }
  462.                 else if(Cal_Setp == 2)        //對陀螺儀累加
  463.                 {
  464.                         x_sum += ((int *)&tp)[4];  //讀取陀螺儀數據
  465.                         y_sum += ((int *)&tp)[5];
  466.                         z_sum += ((int *)&tp)[6];
  467.                         if(++Cal_cnt >= 64)
  468.                         {
  469.                                 g_x = x_sum / 64;
  470.                                 g_y = y_sum / 64;
  471.                                 g_z = z_sum / 64;
  472.                                 float_x_sum = 0;        float_y_sum = 0;
  473.                                 Cal_cnt  = 0;
  474.                                 Cal_Setp = 3;
  475.                         }
  476.                 }
  477.                 else if(Cal_Setp == 3)        //對X Y角度累加
  478.                 {
  479.                         float_x_sum += AngleX;
  480.                         float_y_sum += AngleY;
  481.                         if(++Cal_cnt >= 64)
  482.                         {
  483.                                 Cal_cnt  = 0;
  484.                                 Cal_Setp = 0;
  485.                                 a_x = float_x_sum / 64.0;
  486.                                 a_y = float_y_sum / 64.0;
  487.                                 IAP_Gyro();
  488.                                 SetBuzzer(5,1,1);
  489.                         }
  490.                 }
  491.         }
  492.         else
  493.         {
  494.                 Cal_Setp = 0;
  495.                 Cal_cnt  = 0;
  496.         }
  497. }

  499. // ===================== 主函數 =====================
  500. void main(void)
  501. {

  503.         //所有I/O口全設為準雙向，弱上拉模式
  504.         P0M0=0x00;        P0M1=0x00;
  505.         P1M0=0x00;        P1M1=0x00;
  506.         P2M0=0x00;        P2M1=0x00;
  507.         P3M0=0x00;        P3M1=0x00;
  508.         P4M0=0x00;        P4M1=0x00;
  509.         P5M0=0x00;        P5M1=0x00;
  510.         P6M0=0x00;        P6M1=0x00;
  511.         P7M0=0x00;        P7M1=0x00;

  513.         PPM1 = 128;
  514.         PPM2 = 128;
  515.         PPM3 = 0;
  516.         PPM4 = 128;

  518.         PWMGO();

  520.         P_Light  = 0;
  521.         P_BUZZER = 0;
  522.         P5n_push_pull(0x30);

  524.         adc_init();    //啟動A/D
  525.        
  526.         PCA_config();

  528.         delay_ms(100);
  529.         IAPRead();                //讀取陀螺儀靜差
  530.         InitMPU6050();        //初始化MPU-6050
  531.         delay_ms(100);

  533.         PWMCR =  0xc0;//ECBI;        //允許PWM計數器歸零中斷
  534.         EA = 1;        //允許總中斷
  535.        
  536.         cnt_start = 0;
  537.         while(cnt_start < 25)        //等待油門最小        20ms * 25 = 500ms
  538.         {
  539.                 if(B_PPM3_OK)        //油門
  540.                 {
  541.                         B_PPM3_OK = 0;
  542.                         if(PPM3_Cap <= 1200)        cnt_start++;
  543.                 }
  544.                 delay_ms(1);
  545.         }
  546.         P_Light  = 0;
  547.        
  548.         cnt_start = 0;

  550.         SetBuzzer(5,1,1);
  551.        

  553. //==============================================
  554.         UART1_config();        // 選擇波特率, 2: 使用Timer2做波特率, 其它值: 使用Timer1做波特率.
  555.         PrintString1("STC15W4K系列大四軸飛控程序!\r\n");        //SUART1發送一個字符串
  556. //==============================================

  558.         B_Start = 0;        //上電禁止運行

  560.         while(1)
  561.         {
  562.                 if(B_PPM1_OK)        //左右(橫滾)
  563.                 {
  564.                         B_PPM1_OK = 0;
  565.                                  if(PPM1_Cap < 1120)        PPM1_Cap = 1120;
  566.                         else if(PPM1_Cap > 1880)        PPM1_Cap = 1880;
  567.                         PPM2 = (u8)((PPM1_Cap-1116)/3);        //轉為0~255, 中間值為128
  568.                 }
  569.                
  570.                 if(B_PPM2_OK)        //前后(俯仰)
  571.                 {
  572.                         B_PPM2_OK = 0;
  573.                                  if(PPM2_Cap < 1120)        PPM2_Cap = 1120;
  574.                         else if(PPM2_Cap > 1880)        PPM2_Cap = 1880;
  575.                         PPM1 = (u8)((PPM2_Cap-1116)/3);        //轉為0~255, 中間值為128
  576.                 }
  577.                
  578.                 if(B_PPM4_OK)        //航向
  579.                 {
  580.                         B_PPM4_OK = 0;
  581.                                  if(PPM4_Cap < 1056)        PPM4_Cap = 1056;
  582.                                  if(PPM4_Cap > 1940)        PPM4_Cap = 1940;
  583.                                  if(PPM4_Cap < 1440)        PPM4_Cap = PPM4_Cap + 60;
  584.                         else if(PPM4_Cap > 1560)        PPM4_Cap = PPM4_Cap - 60;
  585.                         else        PPM4_Cap = 1500;
  586.                         PPM4 = (u8)((PPM4_Cap-1116)/3);        //轉為0~255, 中間值為128
  587.                 }
  588.                
  589.                 if(B_PPM3_OK)        //油門
  590.                 {
  591.                         B_PPM3_OK = 0;
  592.                         if(PPM3_Cap < 1000)        PPM3_Cap = 1000;
  593.                         if(PPM3_Cap > 1900)        PPM3_Cap = 1900;

  595.                         if(B_Start)                //正在運行時,
  596.                         {
  597.                                 PPM3 = (u8)((PPM3_Cap-1000)/4);        //轉為0~255,        實際8~225
  598.                                 if(PPM3 < 32)        PPM3 = 32;
  599.                                
  600.                                 if((PPM1 < 50) && (PPM2 < 50) && (PPM3_Cap < 1120) && (PPM4 > 200))        //下外八, 禁止
  601.                                 {
  602.                                         if(++cnt_start >= 50)        //1秒
  603.                                         {
  604.                                                 cnt_start = 0;
  605.                                                 B_Start = 0;
  606.                                                 SetBuzzer(1,1,2);
  607.                                         }
  608.                                 }
  609.                                 else        cnt_start = 0;
  610.                         }
  611.                         else        //禁止運行時, 等待內八開啟
  612.                         {
  613.                                 PPM3 = 0;
  614.                                 if((PPM1 < 50) && (PPM2 > 200) && (PPM3_Cap < 1120) && (PPM4 < 50))        //下內八, 啟動
  615.                                 {
  616.                                         if(++cnt_start >= 50)        //1秒
  617.                                         {
  618.                                                 cnt_start = 0;
  619.                                                 B_Start = 1;
  620.                                                 SetBuzzer(5,1,1);
  621.                                         }
  622.                                 }
  623.                                 else if((PPM1 > 200) && (PPM2 > 200) && (PPM3_Cap > 1850) && (PPM4 < 50))        //上內八, 水平校準
  624.                                 {
  625.                                         if(++cnt_start >= 50)        //1秒
  626.                                         {
  627.                                                 cnt_start = 0;
  628.                                                 SetBuzzer(2,1,1);
  629.                                                 Cal_Setp = 1;
  630.                                         }
  631.                                 }
  632.                                 else if((PPM1 > 200) && (PPM2 < 50) && (PPM3_Cap > 1850) && (PPM4 > 200))        //上外八, 取消水平校準
  633.                                 {
  634.                                         if(++cnt_start >= 50)        //1秒
  635.                                         {
  636.                                                 cnt_start = 0;
  637.                                                 g_x = 0;
  638.                                                 g_y = 0;
  639.                                                 g_z = 0;
  640.                                                 a_x = 0;
  641.                                                 a_y = 0;
  642.                                                 IAP_Gyro();
  643.                                                 SetBuzzer(1,1,2);
  644.                                         }
  645.                                 }
  646.                                 else        cnt_start = 0;
  647.                         }
  648.                 }


  651.                 if(B_8ms)                //8ms到
  652.                 {
  653.                         B_8ms = 0;
  654.                        
  655.                         if(Cal_Setp != 0)        AutoCal();        //是否執行自動校準序列
  656.                         AD();                // 讀ADC計算電壓

  658.                         if(++cnt_100ms >= 12)        cnt_100ms = 0,        beep();        //100ms處理一次蜂鳴器

  660.                         B = cnt_ms;
  661.                         ++cnt_ms;
  662.                         B = (B ^ cnt_ms) & cnt_ms;

  664.                         if(B2)                //64ms
  665.                         {
  666.                                 if(!B_BAT_LOW && (YM_LostCnt < 120))        //電壓足, 信號正常
  667.                                 {
  668.                                         if(!B_Start)        P_Light = 0;        // 空閑時, 則慢閃(每2048ms亮64ms)
  669.                                         else                         P_Light = 1;        // 啟動后, 燈常亮
  670.                                 }
  671.                         }
  672.                         else if(B4)                //256ms
  673.                         {
  674.                                 if(B_BAT_LOW || (YM_LostCnt >= 120))        P_Light = ~P_Light;                //電壓低, 或無信號, 航燈閃爍 2HZ
  675.                         }
  676.                         else if(B6)                //1024ms
  677.                         {
  678.                                 if(Battery < 1090)        B_BAT_LOW = 1;        else if(Battery > 1110)        B_BAT_LOW = 0;        //<10.90V電壓低, >11.10V電壓夠
  679.                                
  680.                                 if(B_BAT_LOW)        SetBuzzer(1,1,2);        //電壓低
  681.                                
  682.                                 if(B_rtn_ADC0)        Return_Message();        //請求返回ADC0數據

  684.                                 if(!B_BAT_LOW && (YM_LostCnt < 120))        P_Light = 1;        //遙控信號正常,        電壓正常時
  685.                         }
  686.                         else if(B7)                //2048ms
  687.                         {
  688.                                 if(!B_BAT_LOW && (YM_LostCnt >= 120))        SetBuzzer(1,1,3);        //電壓正常時 遙控信號丟失, 每兩秒短鳴3次,
  689.                         }
  690.                 }


  693.                 if(UART1_cmd != 0)
  694.                 {
  695.                         if(UART1_cmd == 'a')                //PC發送a，飛控返回一些參數
  696.                         {
  697.                                 B_rtn_ADC0 = ~B_rtn_ADC0;
  698.                         }
  699.                         UART1_cmd = 0;
  700.                 }
  701.                
  702.                
  703.                 if((TX1_Read != TX1_Write) && (!B_TX1_Busy))        //有數據要發送, 并且發送空閑
  704.                 {
  705.                         SBUF = TX1_Buffer[TX1_Read];
  706.                         B_TX1_Busy = 1;
  707.                         if(++TX1_Read >= TX1_LENGTH)        TX1_Read = 0;
  708.                 }

  710.         }
  711. }

  713. //=========================================================

  715. void        Return_Message(void)
  716. {
  717.         TX1_write2buff('V');
  718.         TX1_write2buff('=');
  719.         TX1_write2buff(Battery/1000 + '0');
  720.         TX1_write2buff((Battery%1000)/100 + '0');
  721.         TX1_write2buff('.');
  722.         TX1_write2buff((Battery%100)/10 + '0');
  723.         TX1_write2buff(Battery%10 + '0');
  724.         TX1_write2buff(' ');
  725.         TX1_write2buff(' ');

  727.         PrintString1("AngleX=");
  728.         TX1_int_value((int)(AngleX * 10));

  730.         PrintString1("AngleY=");
  731.         TX1_int_value((int)(AngleY * 10));

  733.         PrintString1("AngleZ=");
  734.         TX1_int_value((int)(Angle_gz * 10));

  736.         PrintString1("a_x=");
  737.         TX1_int_value(a_x * 10);
  738.         PrintString1("a_y=");
  739.         TX1_int_value(a_y * 10);
  740.         PrintString1("g_z=");
  741.         TX1_int_value(g_z * 10);

  743.         TX1_cnt = 0;
  744.         TX1_write2buff(0x0d);
  745.         TX1_write2buff(0x0a);
  746. }


  749. void  delay_ms(u8 ms)
  750. {
  751.      u16 i;
  752.          do
  753.          {
  754.                  i = MAIN_Fosc / 13000;
  755.                 while(--i)        ;   //13T per loop
  756.      }while(--ms);
  757. }


  760. void        TX1_int_value(int i)
  761. {
  762.         if(i < 0)        TX1_write2buff('-'),        i = 0 - i;
  763.         else                TX1_write2buff(' ');
  764.         TX1_write2buff(i / 1000 + '0');
  765.         TX1_write2buff((i % 1000) / 100 + '0');
  766.         TX1_write2buff((i % 100) / 10 + '0');
  767.         TX1_write2buff('.');
  768.         TX1_write2buff(i % 10 + '0');
  769.         TX1_write2buff(' ');
  770.         TX1_write2buff(' ');
  771. }

  773. /*************** 裝載串口1發送緩沖 *******************************/
  774. void TX1_write2buff(u8 dat)        //寫入發送緩沖，指針+1
  775. {
  776.         TX1_Buffer[TX1_Write] = dat;
  777.         if(++TX1_Write >= TX1_LENGTH)        TX1_Write = 0;
  778. }


  781. //========================================================================
  782. // 函數: void PrintString1(u8 *puts)
  783. // 描述: 串口1發送字符串函數。
  784. // 參數: puts:  字符串指針.
  785. // 返回: none.
  786. // 版本: VER1.0
  787. // 日期: 2014-11-28
  788. // 備注:
  789. //========================================================================
  790. void PrintString1(u8 *puts)        //發送一個字符串
  791. {
  792.         for (; *puts != 0;        puts++)   TX1_write2buff(*puts);        //遇到停止符0結束
  793. }

  795. //========================================================================
  796. // 函數: SetTimer2Baudrate(u16 dat)
  797. // 描述: 設置Timer2做波特率發生器。
  798. // 參數: dat: Timer2的重裝值.
  799. // 返回: none.
  800. // 版本: VER1.0
  801. // 日期: 2014-11-28
  802. // 備注:
  803. //========================================================================

  805. void        SetTimer2Baudrate(u16 dat)        // 選擇波特率, 2: 使用Timer2做波特率, 其它值: 使用Timer1做波特率.
  806. {
  807.         AUXR &= ~(1<<4);        //Timer stop
  808.         AUXR &= ~(1<<3);        //Timer2 set As Timer
  809.         AUXR |=  (1<<2);        //Timer2 set as 1T mode
  810.         TH2 = dat / 256;
  811.         TL2 = dat % 256;
  812.         IE2  &= ~(1<<2);        //禁止中斷
  813.         AUXR |=  (1<<4);        //Timer run enable
  814. }


  817. //========================================================================
  818. // 函數: void        UART1_config(u8 brt)
  819. // 描述: UART1初始化函數。
  820. // 參數: brt: 選擇波特率, 2: 使用Timer2做波特率, 其它值: 使用Timer1做波特率.
  821. // 返回: none.
  822. // 版本: VER1.0
  823. // 日期: 2014-11-28
  824. // 備注:
  825. //========================================================================
  826. void        UART1_config(void)
  827. {
  828.         /*********** 波特率使用定時器2 *****************/
  829.         AUXR |= 0x01;                //S1 BRT Use Timer2;
  830.         SetTimer2Baudrate(65536UL - (MAIN_Fosc / 4) / Baudrate1);

  832.         /*********** 波特率使用定時器1 *****************/
  833. /*        TR1 = 0;
  834.         AUXR &= ~0x01;                //S1 BRT Use Timer1;
  835.         AUXR |=  (1<<6);        //Timer1 set as 1T mode
  836.         TMOD &= ~(1<<6);        //Timer1 set As Timer
  837.         TMOD &= ~0x30;                //Timer1_16bitAutoReload;
  838.         TH1 = (u8)((65536UL - (MAIN_Fosc / 4) / Baudrate1) / 256);
  839.         TL1 = (u8)((65536UL - (MAIN_Fosc / 4) / Baudrate1) % 256);
  840.         ET1 = 0;        //禁止中斷
  841.         INT_CLKO &= ~0x02;        //不輸出時鐘
  842.         TR1  = 1;
  843. */        //========================================================================

  845.         SCON = (SCON & 0x3f) | 0x40;        //UART1模式, 0x00: 同步移位輸出, 0x40: 8位數據,可變波特率, 0x80: 9位數據,固定波特率, 0xc0: 9位數據,可變波特率
  846.         PS  = 1;        //高優先級中斷
  847.         ES  = 1;        //允許中斷
  848.         REN = 1;        //允許接收
  849.         P_SW1 &= 0x3f;
  850.         P_SW1 |= 0x00;                //UART1 switch to, 0x00: P3.0 P3.1, 0x40: P3.6 P3.7, 0x80: P1.6 P1.7 (必須使用內部時鐘)
  851. //        PCON2 |=  (1<<4);        //內部短路RXD與TXD, 做中繼, ENABLE,DISABLE

  853.         B_TX1_Busy = 0;
  854.         TX1_Read   = 0;
  855.         TX1_Write  = 0;
  856.         UART1_cmd  = 0;
  857.         TX1_cnt    = 0;
  858. }


  861. //========================================================================
  862. // 函數: void UART1_int (void) interrupt UART1_VECTOR
  863. // 描述: UART1中斷函數。
  864. // 參數: nine.
  865. // 返回: none.
  866. // 版本: VER1.0
  867. // 日期: 2014-11-28
  868. // 備注:
  869. //========================================================================
  870. void UART1_int (void) interrupt 4
  871. {
  872.         if(RI)
  873.         {
  874.                 RI = 0;
  875.                 UART1_cmd = SBUF;
  876.         }

  878.         if(TI)
  879.         {
  880.                 TI = 0;
  881.                 B_TX1_Busy = 0;
  882.         }
  883. }



  887. void        PCA_config(void)
  888. {
  889.         PPM1_Rise_TimeOut = 0;
  890.         PPM2_Rise_TimeOut = 0;
  891.         PPM3_Rise_TimeOut = 0;
  892.         PPM4_Rise_TimeOut = 0;

  894.         CR = 0;
  895.         CH = 0;
  896.         CL = 0;
  897.         AUXR1 = (AUXR1 & ~(3<<4)) | PCA_P12_P17_P16_P15_P14;        //切換IO口
  898.         CMOD  = (CMOD  & ~(7<<1)) | PCA_Clock_12T;                                //選擇時鐘源  STC8F8K D版本
  899. //        CMOD  = (CMOD  & ~1) | 1;                                                                //ECF
  900.         PPCA = 1;        //高優先級中斷

  902.         CCAPM0     = PCA_Mode_Capture | PCA_Rise_Active | PCA_Fall_Active | ENABLE;        //工作模式, 中斷模式
  903.         PCA_PWM0   = PCA_PWM_8bit;        //PWM寬度
  904. //        CCAP0L = (u8)CCAP0_tmp;                        //將影射寄存器寫入捕獲寄存器，先寫CCAPnL
  905. //        CCAP0H = (u8)(CCAP0_tmp >> 8);        //后寫CCAPnH

  907.         CCAPM1     = PCA_Mode_Capture | PCA_Rise_Active | PCA_Fall_Active | ENABLE;        //工作模式, 中斷模式
  908.         PCA_PWM1   = PCA_PWM_8bit;        //PWM寬度
  909. //        CCAP1L = (u8)CCAP1_tmp;                        //將影射寄存器寫入捕獲寄存器，先寫CCAPnL
  910. //        CCAP1H = (u8)(CCAP1_tmp >> 8);        //后寫CCAPnH

  912.         CCAPM2     = PCA_Mode_Capture | PCA_Rise_Active | PCA_Fall_Active | ENABLE;        //工作模式, 中斷模式
  913.         PCA_PWM2   = PCA_PWM_8bit;        //PWM寬度
  914. //        CCAP2L = (u8)CCAP2_tmp;                        //將影射寄存器寫入捕獲寄存器，先寫CCAPnL
  915. //        CCAP2H = (u8)(CCAP2_tmp >> 8);        //后寫CCAPnH

  917.         CCAPM3     = PCA_Mode_Capture | PCA_Rise_Active | PCA_Fall_Active | ENABLE;        //工作模式, 中斷模式
  918.         PCA_PWM3   = PCA_PWM_8bit;        //PWM寬度
  919. //        CCAP3L = (u8)CCAP3_tmp;                        //將影射寄存器寫入捕獲寄存器，先寫CCAPnL
  920. //        CCAP3H = (u8)(CCAP3_tmp >> 8);        //后寫CCAPnH

  922.         CR = 1;
  923. }


  926. //========================================================================
  927. // 函數: void        PCA_Handler (void) interrupt PCA_VECTOR
  928. // 描述: PCA中斷處理程序.
  929. // 參數: None
  930. // 返回: none.
  931. // 版本: V1.0, 2012-11-22
  932. //========================================================================
  933. void        PCA_Handler (void) interrupt PCA_VECTOR
  934. {
  935.         if(CCF0)                //PCA模塊0中斷
  936.         {
  937.                 CCF0 = 0;                //清PCA模塊0中斷標志
  938.                 if(P17)        //上升沿
  939.                 {
  940.                         CCAP0_RiseTime = ((u16)CCAP0H << 8) + CCAP0L;        //讀CCAP0
  941.                         PPM1_Rise_TimeOut = 1;        //收到上升沿, 高電平限時
  942.                 }
  943.                 else        //下降沿
  944.                 {
  945.                         CCAP_FallTime = ((u16)CCAP0H << 8) + CCAP0L;        //讀CCAP0
  946.                         if((PPM1_Rise_TimeOut != 0) && (PPM1_Rise_TimeOut < 3))        //收到過上升沿, 高電平也沒有溢出
  947.                         {
  948.                                 CCAP_FallTime = (CCAP_FallTime - CCAP0_RiseTime) >> 1;        //為了好處理, 轉成單位為us
  949.                                 if((CCAP_FallTime >= 800) && (CCAP_FallTime <= 2500))
  950.                                 {
  951.                                         if(++PPM1_RxCnt >= 5)        PPM1_RxCnt = 5;                //連續接收到5個脈沖
  952.                                         if(PPM1_RxCnt == 5)
  953.                                         {
  954.                                                 if(!B_PPM1_OK)
  955.                                                 {
  956.                                                         PPM1_Cap = CCAP_FallTime;
  957.                                                         B_PPM1_OK = 1;                //標志收到一個脈沖
  958.                                                         PPM1_Rx_TimerOut = 12;        //限時收不到脈沖
  959.                                                 }
  960.                                         }
  961.                                 }
  962. ……………………

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




所有資料51hei提供下載:
四軸飛控-STC8A8K64S4A12-LQFP44-PPM-V10.rar (3.86 MB, 下載次數: 443)



作者: jlian168    時間: 2017-11-28 11:24
下來試試...
作者: wuxishun    時間: 2017-12-4 14:52
謝謝分享，有時間做一個玩下
作者: twjccmx    時間: 2018-1-5 14:40
感謝分享，有空學習下
作者: anoo    時間: 2018-5-6 22:02
感謝分享,支持原創,
作者: zhoudianhong    時間: 2018-7-29 16:26
為什么怎么也下不完呢，是有問題？
作者: yangzhe6140    時間: 2018-9-5 16:57
關于玩四軸，我認為深入的玩法就是研究軟硬件，特別是軟件，如果只是組裝比人的成品，沒啥成就感；本著此想法所以下載學習此算法！
作者: mark13777    時間: 2018-9-25 09:12
感謝分享，對于學習很有幫助
作者: lc110    時間: 2018-9-27 16:05
謝謝你的分享
作者: war3mars    時間: 2019-4-16 09:24
樓主，可否加個QQ，跟你學習下，我的QQ 75750462
作者: caiseshamo    時間: 2019-5-7 11:22
感謝~~~
作者: samu12a    時間: 2019-6-9 10:08
謝謝樓主分享！
作者: 51單片小白v    時間: 2019-7-28 14:28
感謝樓主分享
作者: wulingqing    時間: 2019-7-28 17:02
謝謝分享，學著做一個四軸飛控
作者: 慢牽牛    時間: 2019-9-29 23:08
下載下來學習學習
作者: 987654321123    時間: 2019-11-2 18:18
下載下來好好學習一下代碼
作者: woojoon1981    時間: 2020-1-16 16:55
正在學習無人機，謝謝你的分享
作者: serafim    時間: 2020-2-5 11:30
感謝分享，想問下，如果機身水平不變四個螺旋槳前后左右偏轉改變飛行方向是否可行？機身姿態與控制方向非耦合狀態，同時機身可在空中改變角度懸停。
作者: 鑒啊啊    時間: 2020-2-10 17:26
請問您有飛行的視頻么
作者: peeta    時間: 2020-3-18 15:11
謝謝分享
作者: shenyuqiu    時間: 2021-4-22 08:05
關鍵還是軟件算法
作者: 小劉要加油    時間: 2021-4-30 22:28
這個厲害啊，想學但是沒怎么看懂哈哈
作者: 汪eric    時間: 2021-5-14 22:27
感謝樓主分享，小白一名前來膜拜學習
作者: WFX777888    時間: 2021-5-23 19:48
學習無人機，謝謝你的分享
作者: CHNO    時間: 2021-6-5 17:11
從宏晶官網下載，然后打過板子，四軸可以平穩飛行，就是油門開大后不能穩定的停在原地，會偏，正在查找原因中，
作者: lzl12399    時間: 2021-6-10 11:45
CHNO 發表于 2021-6-5 17:11
從宏晶官網下載，然后打過板子，四軸可以平穩飛行，就是油門開大后不能穩定的停在原地，會偏，正在查找原因 ...

板子打樣，自己畫得還是有現成得，小弟也想玩玩
作者: CHNO    時間: 2021-6-11 10:32
lzl12399 發表于 2021-6-10 11:45
板子打樣，自己畫得還是有現成得，小弟也想玩玩

我是自己畫的
作者: CHNO    時間: 2021-6-11 11:29
分享一下調試經驗
1.起飛后會飛斜：在水平的地板上將四軸放平，開啟遙控，油門打到最低，串口以文本輸入a，開始串口打印X，Y的角度，大概是+-2左右，將這個數記下來，然后在程序這里加補償（紅字的部分），然后重新編譯后下載程序，然后在開啟串口打印，這時輸出一般都在0-0.1這兒穩定了，起飛后，無風的情況下不會亂飛。
        AngleX = asin(2*(q0*q2 - q1*q3 )) * 57.2957795f+1.9; // 俯仰   換算成度
        AngleY = asin(2*(q0*q1 + q2*q3 )) * 57.2957795f+0.8; // 橫滾

2.遙控器通道正反要按資料上的圖片來撥，資料要求美國手，我買的日本手，實則都能用。用日本手要改接收機和單片機線的位置，用萬用表對照程序注釋一看便知。
3.這個程序配合MC6遙控器十分好用方便，可是把程序改成串口無線控制會發生一些問題，感覺是串口接受數據多，中斷頻率較高，而PWM中斷等級較低，老是打斷PWM中斷，然后現象是某個固定的腳PWM輸出會比其他高很多，串口改一下波特率或者發射加個延時，這個現象又轉移到其他PWM引腳，目前還在優化中，，，，，，
4.前人栽樹后人乘涼，由心的感謝程序作者無私的分享。


作者: putiz    時間: 2021-12-26 17:38
大家好，我看了幾天的代碼了，也嘗試打印了一些數據來分析。
現狀是剛開始啟動后，電機不會啟動，不會低速旋轉。即使偶爾有幾個會旋轉，也不會受遙控器的控制。
經過打印一些信息發現：
  1.         SW2_tmp = P_SW2;        //保存SW2設置
  2.         EAXSFR();        //訪問XFR
  3.         PWM0T2 = (u16)(PWM0 * 2);
  4.         PWM1T2 = (u16)(PWM1 * 2);
  5.         PWM2T2 = (u16)(PWM2 * 2);       
  6.         PWM3T2 = (u16)(PWM3 * 2);        //進行輸出脈沖信號更新
  7.         P_SW2  = SW2_tmp;        //恢復SW2設置
復制代碼

這樣的代碼，這些值不會發生變化和更新
  1.         PWM0T1 = 4000;//第一個翻轉點 4000
  2.         PWM1T1 = 4000;
  3.         PWM2T1 = 4000;
  4.         PWM3T1 = 4000;
  5. //        PWM4T1 = 4000;
  6. //        PWM5T1 = 4000;
  7. //        PWM6T1 = 4000;
  8. //        PWM7T1 = 4000;

  10.         PWM0T2 = 2000;  //第二個翻轉點 2000
  11.         PWM1T2 = 2000;
  12.         PWM2T2 = 2000;
  13.         PWM3T2 = 2000;
  14. //        PWM4T2 = 2000;
  15. //        PWM5T2 = 2000;
  16. //        PWM6T2 = 2000;
  17. //        PWM7T2 = 2000;
復制代碼

在這樣的初始化后打印出來的數據卻是0 4000 8000 12337（PWM0T1 PWM1T1 PWM2T1 PWM3T1）
和初始化結果也是不一樣的。
為什么我找這樣的信息呢，因為我感覺首先遙控器不能控制波形的輸出，剛開始輸出的波形也不能讓電動機啟動。
因此我想試著找找這個原因，但是這個值不知道為什么不會發生變化
請問大佬可以回復下嗎？真的不知道怎么辦
作者: putiz    時間: 2021-12-26 17:41
CHNO 發表于 2021-6-11 11:29
分享一下調試經驗
1.起飛后會飛斜：在水平的地板上將四軸放平，開啟遙控，油門打到最低，串口以文本輸入a ...

大佬，可以加下聯系方式嗎？
自己遇到了一些問題，想向您請教一下
作者: putiz    時間: 2021-12-26 18:05
CHNO 發表于 2021-6-5 17:11
從宏晶官網下載，然后打過板子，四軸可以平穩飛行，就是油門開大后不能穩定的停在原地，會偏，正在查找原因 ...

大佬，可以加下好友交流一下嗎
2410025784
作者: CHNO    時間: 2022-1-1 10:49
putiz 發表于 2021-12-26 18:05
大佬，可以加下好友交流一下嗎
2410025784

你好，已加未見回復，因為不清楚你那邊啥情況，就這邊回復一下我大概的調試過程吧
1.程序里面有個電池電壓檢測（ADC部分），要保證這邊沒問題，檢測電壓低是啟動不了的，我這邊是直接把該端口和VCC接一起的。（因為我用的隔離電源，不能和鋰電池共地）
2.然后你的電路是否用的資料提供的電路？還是略有修改？PCA輸入假如用光耦隔離的話，受光側上拉電阻取值會影響波形的好壞，我這用的521光耦，原本用的103電阻，發現也是無法啟動，換成102就可以了，實際上要更小才合適。
3.先看看程序有沒有進入循環，還是卡在油門最小等待這一步，我在這兒加上串口打印配合調試
  PrintString1("注意準備等待油門最小了\r\n");
        while(cnt_start < 25)        //等待油門最小        20ms * 25 = 500ms
        {
                if(B_PPM3_OK)        //油門
                {
                        B_PPM3_OK = 0;
                        if(PPM3_Cap <= 1200)        cnt_start++;
                }
                delay_ms(1);
        }
        PrintString1("油門最小測試通過\r\n");
當油門通過后就是主要的工作啦，用串口不停地查看接收的數據是否與遙控一起在變化，
void        Return_Message(void)
{
        TX1_write2buff('V');
        TX1_write2buff('=');
        TX1_write2buff(Battery/1000 + '0');
        TX1_write2buff((Battery%1000)/100 + '0');
        TX1_write2buff('.');
        TX1_write2buff((Battery%100)/10 + '0');
        TX1_write2buff(Battery%10 + '0');
        TX1_write2buff(' ');
        TX1_write2buff(' ');
        //從這兒開始
        PrintString1("PPM1=");
        TX1_int_value((int)(PPM1 * 10));
        PrintString1("PPM2=");
        TX1_int_value((int)(PPM2 * 10));
        PrintString1("PPM3=");
        TX1_int_value((int)(PPM3 * 10));
        PrintString1("PPM4=");
        TX1_int_value((int)(PPM4 * 10));
/*     PrintString1("AngleX=");
        TX1_int_value((int)(AngleX * 10));
        PrintString1("AngleY=");
        TX1_int_value((int)(AngleY * 10));
        PrintString1("AngleZ=");
        TX1_int_value((int)(Angle_gz * 10));
*/
        PrintString1("a_x=");
        TX1_int_value(a_x * 10);
        PrintString1("a_y=");
        TX1_int_value(a_y * 10);
        PrintString1("g_z=");
        TX1_int_value(g_z * 10);
        TX1_cnt = 0;
        TX1_write2buff(0x0d);
        TX1_write2buff(0x0a);
}
這樣就可以很直觀的看出來遙控的接收情況了，即使線接反了，也可以看出實時的數據變化，找出對應的搖桿，因為這樣很方便，我把買的日本手該成了中國手。。。。。
4.然后晶振頻率和EEPROM大小不能錯，遙控器通道正反要按資料圖片來撥，其他沒什么了，串口這兒就可以看出很多情況了，最后LQFP44我用的G版本
作者: chenyucy72    時間: 2022-5-25 08:23
哈哈，剛在官網上看到，然后在家里又看到，更想做一臺來玩了
作者: ysld    時間: 2024-3-11 14:13

謝謝分享，有時間做一個玩
作者: 1103479082    時間: 2026-2-5 15:58
26年了還有人嗎
作者: 千早愛音愛玩51    時間: 2026-2-6 19:37
原來51的性能足夠跑飛控



歡迎光臨 (http://www.denmoz.com/bbs/) Powered by Discuz! X3.1