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

標題: 四軸飛行器程序 [打印本頁]
作者: 陳極品    時間: 2016-5-31 22:44
標題: 四軸飛行器程序
偶爾在網上發現一個好玩的四軸飛行器程序，跟大家分享一下，也希望動手能力強的童鞋能做出來，純屬愛心分享，版權歸作者所有，切勿用于商業用途。




  2. //                                        STCunio

  4. //**********************************遙控器程序Rev1.3正式版*************************
  5. //聲明：程序作者不會對本程序進行任何升級了，該程序就是該硬件的最終版本
  6. //本程序可以自行二次開發，不過需要將開發后的版本上傳到阿莫論壇，這樣本程序開源才有意義，謝謝！
  7. //          程序：SWUST 電氣自動化13級 LQM

  9. //          本程序適用于STC四軸的小日本手遙控器（右手油門）
  10. //右手上下為油門，左右為橫滾
  11. //左手上下為俯仰，左右為旋轉
  12. //                                 MCU工作頻率28MHZ！！！
  13. #include <rtx51tny.h>
  14. #include <STC15F2K60S2.H>
  15. #include <NRF24L01.H>
  16. #include <AD.H>
  17. sbit RLED=P0^5;
  18. sbit GLED=P0^6;
  19. sbit LKEY=P4^7;
  20. sbit RKEY=P3^4;

  22. volatile int idata ay,ax,by,bx;
  23. volatile int idata cy,cx,dy,dx;
  24. volatile float idata battery;
  25. unsigned char idata TxBuf[20]={0};
  26. unsigned char idata RxBuf[20]={0};
  27. void IO_and_Init();

  29. void AD() _task_ 0 //獲取AD采樣數據
  30. {
  31.         IO_and_Init();   //初始化I/O口
  32.         os_create_task (1);  //啟動進程1
  33.         for(;;)
  34.         {
  35.   cy=getADCResult(3); //讀取4個搖桿通道每個通道的8位數據，取值范圍0-255
  36.         Delay(10);
  37.         cx=getADCResult(2);
  38.         Delay(10);
  39.         dy=getADCResult(1);
  40.   Delay(10);
  41.         dx=getADCResult(0);
  42.         Delay(10);
  43.         battery=(getADCResult(4)*5.05*100)/256;   //電池電壓檢測通道 低于3.7V亮紅燈
  44.         Delay(10);
  45.         if(battery<=370)
  46.   {
  47.         RLED=1;GLED=0;
  48.         }
  49.         else
  50.         {
  51.         RLED=0;GLED=1;
  52.         }
  53.         os_wait(K_IVL,3,0);//延時3個節拍
  54. }
  55. }
  56. void NRF24L01()  _task_ 1
  57. {       
  58.         while(1)
  59.         {
  60.          TxBuf[0]++;
  61.          TxBuf[1]=128;
  62.          TxBuf[2]=128;
  63.          TxBuf[3]=128;
  64.          if(cy<20) {goto EXIT;}//當油門拉至最低時遙控器解鎖
  65.          if(RKEY==0) {TxBuf[5]=1;} else {TxBuf[5]=0;}
  66.          if(LKEY==0) {TxBuf[6]=1;} else {TxBuf[6]=0;}
  67.          nRF24L01_TxPacket(TxBuf);//發送TxBuf數組的數據
  68.          os_wait(K_IVL,2,0); //給一定延時讓數據發送完成
  69.         }
  70.         EXIT:
  71.         while(1)
  72.         {
  73.                 if((dy-by)>=255){TxBuf[1]=255;}//用上電記錄的數據對采樣數據進行修正，保證搖桿中位時數據為128
  74.                 else if((dy-by)<=0){TxBuf[1]=0;}
  75.                 else{TxBuf[1]=dy-by;}
  76.                
  77.                 if((dx-bx)>=255){TxBuf[3]=255;}
  78.                 else if((dx-bx)<=0){TxBuf[3]=0;}
  79.                 else{TxBuf[3]=dx-bx;}
  80.                
  81.                 if((cx-ax)>=255){TxBuf[2]=255;}
  82.                 else if((cx-ax)<=0){TxBuf[2]=0;}
  83.                 else{TxBuf[2]=cx-ax;}
  84.                 //油門：TxBuf[4]
  85.     //Yaw：TxBuf[3]
  86.     //俯仰：TxBuf[1]
  87.     //橫滾：TxBuf[2]
  88.                 TxBuf[4]=cy;//油門通道不需處理，直接發送AD檢測的8位數據即可，根據AD采樣原理易知讀取的AD采樣數據不可能為負也不可能大于255
  89.                 if(RKEY==0) {TxBuf[5]=1;} else {TxBuf[5]=0;}
  90.           if(LKEY==0) {TxBuf[6]=1;} else {TxBuf[6]=0;}
  91.                 TxBuf[0]++;
  92.           nRF24L01_TxPacket(TxBuf);
  93.                 os_wait(K_IVL,2,0); //給一定延時讓數據發送完成
  94.         }
  95. }
  96. void IO_and_Init()
  97. {
  98.                 P1M0=0x00;  //P1設為高阻模式
  99.                 P1M1=0xFF;
  100.                 P0M0=0Xff; //其他I/O口設置為準雙向，弱上拉模式
  101.                 P0M1=0X00;
  102.                 P2M0=0X00;
  103.                 P2M1=0X00;
  104.                 P3M0=0X00;
  105.                 P3M1=0X00;
  106.                 P4M0=0X00;
  107.                 P4M1=0X00;
  108.                 P5M0=0Xff;
  109.                 P5M1=0X00;
  110.                 LKEY=1;  //拉高按鍵檢測I/O口電平，按鍵為低電平觸發
  111.                 RKEY=1;
  112.                 init_NRF24L01();  //初始化無線模塊
  113.     adc_init();        //初始化AD檢測模塊
  114.           ax=getADCResult(2)-128; //記錄上電時搖桿的數據作為中位修正，因為搖桿中位要為128即256/2
  115.           Delay(10);
  116.           by=getADCResult(1)-128;
  117.     Delay(10);
  118.           bx=getADCResult(0)-128;        //記錄回中的軸的初始位置數據
  119.           Delay(10);
  120. }
復制代碼


四軸遙控器程序 2.1.rar

109.33 KB, 下載次數: 43, 下載積分: 黑幣 -5

作者: carols2u    時間: 2017-3-18 14:41
很好的源碼 感謝分享
作者: AFFF    時間: 2019-8-10 18:49
請高手指點一下為何沒有main主函數



歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 欧美精品a∨在线观看不卡 国产精品久久国产精品 | 日本精品一区二区三区在线观看视频 | 一区二区三区国产 | 欧美日韩在线成人 | 亚洲aⅴ精品 | 亚洲精品中文字幕中文字幕 | 精品一区二区免费视频 | 美女爽到呻吟久久久久 | 国产特级毛片aaaaaa喷潮 | 久久小视频 | 精品在线观看一区 | 久久久久久久久久久久91 | 国产三级在线观看播放 | 中文字幕乱码一区二区三区 | www国产成人免费观看视频,深夜成人网 | 精品久久久久久亚洲综合网 | 久久国产精品视频 | av在线电影网 | 国产精品视频一区二区三区, | 欧美精品一区二区三区在线 | 国产伦精品一区二区三区照片91 | 成人免费观看男女羞羞视频 | 91在线看视频 | 亚洲国产一区在线 | 亚洲一区在线日韩在线深爱 | 亚洲成人精品国产 | 久久中文字幕在线 | 日韩av免费在线观看 | 精品网 | 亚洲精品二区 | 欧美日韩亚洲一区二区 | 狠狠干狠狠操 | 亚洲一区二区三区四区五区午夜 | 91成人在线| 成人免费网视频 | 91天堂网| 精品毛片在线观看 | 天天操夜夜操 | 亚洲国产成人精品女人久久久 | 国产精品高潮呻吟久久av黑人 | 久久久精品网站 |