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

標題: 51單片機控制舵機 總框 [打印本頁]
作者: c505085670    時間: 2016-11-19 20:43
標題: 51單片機控制舵機 總框
大概寫了一下控制程序  希望對你們有幫助
  1. tpyedef i8 signed char
  2. tpyedef u8 unsigned char

  4. tpyedef i16 signed short int
  5. tpyedef u16 unsigned short int

  7. tpyedef i32 signed long int
  8. tpyedef u32 unsigned long int

  10. #define ELEVEL_LOW                        0                        //低電平
  11. #define ELEVEL_HIGH                        1                        //高電平

  13. #define TIMER_INIT                        10                        //定時器初始時間  單位US

  15. #define STRENG_MINTIME                500                        //舵機最小角度時間 0.5MS
  16. #define STRENG_MAXTIME                2500                //舵機最大角度時間 2.5MS
  17. #define STRENG_TIMERPRO                20000                //舵機周期 20MS

  19. #define STRENG_MINANGLE                0                        //最小角度
  20. #define STRENG_MAXANGLE                185                        //最大角度

  22. #define IO_STRENG10                                                // PORT引腳
  23. #define IO_STRENG20
  24. #define IO_STRENG30
  25. #define IO_STRENG40
  26. #define IO_STRENG50
  27. #define IO_STRENG60

  29. #define IO_STRENG11
  30. #define IO_STRENG21
  31. #define IO_STRENG31
  32. #define IO_STRENG41
  33. #define IO_STRENG51
  34. #define IO_STRENG61

  36. u16 TimerCount = 0;                                                //計數值

  38. float StrEngAccu = 0;                                        //舵機精度
  39. u16 StrEngZeroAngle = 0;                                //零度對應的時間       

  41. void StrEngTimer0_Init(void)                        //定時器初始化
  42. {
  43.        
  44.         StrEngAccu = STRENG_MAXANGLE/((STRENG_MAXTIME - STRENG_MINTIME)/TIMER_INIT);
  45.         StrEngZeroAngle = STRENG_TIMEUS/TimerInitValue;
  46.        
  47.         TH0 = (65535 - TIMER_INIT)/256;
  48.         TL0 = (65535 - TIMER_INIT);
  49.         EA = 1;
  50.         ET0 = 1;
  51.         TR0 = 1;
  52. }

  54. void STRENG_AngleControl(u8 angle,sbit *io)// 0-185角度控制
  55. {
  56.         float regdat = 0;
  57.         u16 angletime = 0;
  58.        
  59.         regdat = (float)angle;
  60.         angletime = (u16)(regdat/StrEngAccu) + (STRENG_MINTIME/TIMER_INIT);
  61.        
  62.         if(angletime > TimerCount)
  63.         {
  64.                 *io = ELEVEL_HIGH;
  65.         }
  66.         else
  67.         {
  68.                 *io = ELEVEL_LOW;
  69.         }
  70. }

  72. void timer0(void) interrupt 0
  73. {
  74.         TimerCount ++;
  75.         TH0 = (65535 - TIMER_INIT)/256;;
  76.         TL0 = (65535 - TIMER_INIT);

  78.         if(TimerCount > (STRENG_TIMERPRO/TIMER_INIT))
  79.         {
  80.                 TimerCount = 0;
  81.         }
  82. }
復制代碼






歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 精品久久久精品 | 日韩毛片在线免费观看 | 日韩在线一区二区 | 成人在线免费电影 | 亚洲国产精品成人 | 97碰碰碰| 毛片链接| 国产成人黄色 | h小视频| 欧美 日韩 国产 在线 | 日韩国产中文字幕 | 亚洲欧洲中文日韩 | av手机免费在线观看 | 一区二区免费 | 亚洲性视频网站 | 亚洲国产精品人人爽夜夜爽 | 精品国产一级片 | 国产日韩精品久久 | 亚洲色综合 | 久久九七 | 国产精品无 | 亚洲精品久久久久久一区二区 | 国产成人精品综合 | 成年网站在线观看 | 亚洲国产成人av好男人在线观看 | 人人玩人人干 | 久久久成人精品 | 男女精品久久 | 99久久婷婷国产综合精品 | 国产一区在线免费观看视频 | 性做久久久久久免费观看欧美 | 日本人爽p大片免费看 | 成人亚洲 | 国产偷录叫床高潮录音 | 麻豆视频在线免费观看 | 91日日 | 久久精品欧美一区二区三区麻豆 | 狠狠爱免费视频 | 久久久夜色精品亚洲 | 超碰一区二区 | 狠狠久久 |