欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 1769|回復(fù): 0
打印 上一主題 下一主題
收起左側(cè)

51單片機(jī)控制舵機(jī) 總框

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:148905 發(fā)表于 2016-11-19 20:43 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
大概寫了一下控制程序  希望對你們有幫助
  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                        //定時(shí)器初始時(shí)間  單位US

  15. #define STRENG_MINTIME                500                        //舵機(jī)最小角度時(shí)間 0.5MS
  16. #define STRENG_MAXTIME                2500                //舵機(jī)最大角度時(shí)間 2.5MS
  17. #define STRENG_TIMERPRO                20000                //舵機(jī)周期 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;                                                //計(jì)數(shù)值

  38. float StrEngAccu = 0;                                        //舵機(jī)精度
  39. u16 StrEngZeroAngle = 0;                                //零度對應(yīng)的時(shí)間       

  41. void StrEngTimer0_Init(void)                        //定時(shí)器初始化
  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. }
復(fù)制代碼


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

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表