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

專注電子技術學習與研究
當前位置:單片機教程網 >> MCU設計實例 >> 瀏覽文章

舵機程序之一個定時器帶32路

作者:藍夢荒   來源:本站原創   點擊數:  更新時間:2013年12月09日   【字體:

關于本程序的幾個問答先寫出來
問:->這個符號是引用結構體成員嗎?為什么不是點“.”呢?

答:指針式結構體的尋址方式。。是個結構體指針的一種用法

問:c51里面還沒用過結構體。。

答:恩 不常用 因為比較耗費資源 占用的ram rom都比變量和數組多 不過可以讓程序條理清晰 呵呵

每四路一組,從占空比從小到大排序,合并相同占空比。從第0組到第7組分時控制。第一次定時為每一組最短的占空比時間,然后中斷處理第2至4路,如果到第2路以及之后路數已大于每組不同占空比路數則結束這一組,拉低4路PWM輸出,進入下一組;否則進行判斷,前一路占空比在pwm[31]數組(保存了每個占空比對應的物理引腳)中的哪個位置,并拉低相應引腳,設置下一次定時時間為排序后相鄰兩占空比之差。短小精干!學習了。

程序中用到的12c5a.h這個頭文件可從 http://www.zg4o1577.cn/f/12c5a.rar 這里下載

//采用了分時和復控混合的控制方法,把20ms分成8個時期(分時控制的思路),

//每個時期同時拉高4路電平對應時間在分別拉低電平(復控的思想),

//最大程度利用定時器

 

#include"12c5a.h"     //STC12C5A
#include"intrins.h"
/***********************************************************************************************/
#define Bijiao_7 31    //為了方便所以在這定義了一個宏,需要控制n路則把#define Bijiao_7   n-1
#define IoPH    P0=0;P1=0;P2=0;P3=0
/***********************************************************************************************/
struct HH
{
 unsigned char geshu[8],Cs;     //重復數值的個數
 unsigned int pwm[8][4];
}xdata Hhpwm={0,{0}},*hpwm;    //創建HH結構體和這樣的一個指針
unsigned int xdata pwm[Bijiao_7+1]=
         {
          500,1000,1500,2500,
          500,1500,2000,2500,
          500,1500,2000,2500,
          500,1500,2000,2500,
          500,1500,2000,2500,
          500,1500,2000,2500,
          500,1500,2000,2500,
          1000,1500,1500,1500
         };
/************************************************全局數據***************************************/
void init_io(void);
void Timer_init(void);
void Timer0(unsigned int us);
void mpf(struct HH *MP,unsigned int *p,unsigned char ong);
void sjcl(struct HH *MP,unsigned char ong);
void Shgx(unsigned int *p);
void daley(unsigned int us);
unsigned int Zt_fh(unsigned char cs,unsigned char);
/************************************************函數聲明****************************************/
void main(void)
{
 hpwm=&Hhpwm;     //初始化結構體指針
 hpwm->Cs=0;
 init_io();
 Timer_init();
 Shgx(pwm);
 Timer0(100);
 while(1)
 {
 ;
 }
}
/**************************************************************************************************
函數名:init_io(void)
功能: io口設置成為推挽工作模式
作者: the sea
時間: ~~~
備注:  io初始化
***************************************************************************************************/
void init_io(void)
{
 P0M1=0;          //設置io口為強推挽
 P0M0=0XFF;

 P1M1=0;
 P1M0=0XFF;

 P2M1=0;
 P2M0=0XFF;

 P3M1=0;
 P3M0=0XFF;
 daley(100);
}
/**************************************************************************************************
函數名: Timer_init(void)
功能: 定時器0初始化
作者: the sea
時間: ~~~
備注: 1T,方式1,16位
***************************************************************************************************/
void Timer_init(void)
{
 EA=1;          //開總中斷
 AUXR|=0xC0;      //T0,T1工作在1T
    TMOD|= 0x11;     //T0工作在方式1,16位
 ET0 = 1;      //開定時器0中斷
}
/**************************************************************************************************
函數名:timer0(unsigned int us)
功能: 定時器0定時函數
參數: us,毫秒。  精確定時。
作者: the sea
時間: ~~~
備注:  晶振11.0592M,工作模式1T
/***************************************************************************************************/
void Timer0(unsigned int us)   
{
 unsigned int valu;
 us>=90? (valu=(us-80)*11) : (valu=us*11) ;      //在分時和復控當中沒有-80,這是誤差矯正,不減的話舵機走位誤差會很大
 TR0=0;
 valu=0xffff-valu;     

    TH0=valu>>8;         //高8位放入th0
    TL0=valu;    //低8位放入tl0
    TR0= 1;       //T0開始工作
}
/**************************************************************************************************
函數名:mpf(unsigned int *p,unsigned char ong)
功能: 把結構體數組內的數據按照從小到大的順序排列之后重新存儲到數組當中
作者: the sea
時間: ~~~
備注:  冒泡法
***************************************************************************************************/
void mpf(struct HH *MP,unsigned int *p,unsigned char ong)  //冒泡法
{
 char i,j;
 unsigned int num;
 for(i=0;i<ong+1;i++)
 {
  *((*MP->pwm)+i)=*(p+i);   //把*p的數據存儲至MP->pwm【】
 }
 for(i=ong;i>0;i--)
  for(j=0;j<(i%4);j++)
  {
   if(MP->pwm[i/4][j]>MP->pwm[i/4][j+1])
   {
    num=MP->pwm[i/4][j];
    MP->pwm[i/4][j]=MP->pwm[i/4][j+1];
    MP->pwm[i/4][j+1]=num;
   }
  }       //冒泡法對大小進行排序,順序是從小到大
}
/**************************************************************************************************
函數名:sjcl(struct HH *MP,unsigned char ong)
功能: 經過冒泡法處理之后再把重復的數據進行處理使得每個數值只保留一個
作者: the sea
時間: ~~~
備注:  大概可以總結為除同存異(前提必須經過冒泡法處理過的數據本函數才有效)
***************************************************************************************************/
void sjcl(struct HH *MP,unsigned char ong)   //數據處理,pwm數組當中大小相同的數值處理存儲到結構體Hpwm
{
 char i,j,num;
 for(i=(ong/4);i>=0;i--)
  {
   num=0;
   for(j=0;j<3;j++)
   {
    if(MP->pwm[i][j]==MP->pwm[i][j+1])
     {
      num++;     
     }
    else
     {
      MP->pwm[i][j-num]=MP->pwm[i][j];
     }
   }
   MP->pwm[i][3-num]=MP->pwm[i][3];
   MP->geshu[i]=4-num;      //排除相同的數據之后數據的數目
  }
}
/**************************************************************************************************
函數名:Shgx(unsigned int *p) 
功能: 更新舵機位置
作者: the sea
時間: ~~~
備注: 刷新
***************************************************************************************************/
void Shgx(unsigned int *p)    //pwm數據更新
{
 char i;
 for(i=Bijiao_7;i>=0;i--)
  pwm[i]=*(p+i);     //數組數據更新
 mpf(hpwm,p,Bijiao_7);
 sjcl(hpwm,Bijiao_7);     //數據更新之后再次刷新處理
}
/**************************************************************************************************
函數名:ZT_fh(unsigned char cs)
功能: 定時器中斷調用,用于返還io口電平狀態數據
作者: the sea
時間: ~~~
備注:
***************************************************************************************************/
unsigned int Zt_fh(unsigned char cs,unsigned char ong)
{
 char i;
  static unsigned int num;
 if(cs==2)
 num=0xf;         //一個周期把num復位至0xf
 for(i=ong;i>=0;i--)
  {
   if(hpwm->pwm[hpwm->Cs][cs-2]==pwm[i+(hpwm->Cs*4)])
   {
    num&=~(1<<i);
   }
  }
  return num;
}
/**************************************************************************************************
函數名:daley(unsigned int us)
功能: 延時
作者: the sea
時間: ~~~
備注:  延時函數
***************************************************************************************************/
void daley(unsigned int us)
{
 unsigned int i,j;
 for(i=100;i>0;i--)
  for(j=us;j>0;j--)
  {
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
  }
}
/**************************************************************************************************
函數名:T0_zd(void) interrupt 1
功能: 定時器0中斷函數
作者: the sea
時間: ~~~
備注:  制造控制舵機所需的pwm
/***************************************************************************************************/
void T0_zd(void) interrupt 1
{
 static unsigned char num=0;
 num++;
 if(num==1)
 {
  switch(hpwm->Cs)
  {
  case 0: P0=0xf;break;
  case 1: P0=0xf<<4;break;
  case 2: P1=0xf;break;
  case 3: P1=0xf<<4;break;
  case 4: P2=0xf;break;
  case 5: P2=0xf<<4;break;
  case 6: P3=0xf;break;
  case 7: P3=0xf<<4;break;
  } 
  Timer0(hpwm->pwm[hpwm->Cs][0]);
 }
 else if(hpwm->geshu[hpwm->Cs]>=num)
 {
  switch(hpwm->Cs)
  {
  case 0: P0=Zt_fh(num,3);break;
  case 1: P0=Zt_fh(num,3)<<4;break;
  case 2: P1=Zt_fh(num,3);break;
  case 3: P1=Zt_fh(num,3)<<4;break;
  case 4: P2=Zt_fh(num,3);break;
  case 5: P2=Zt_fh(num,3)<<4;break;
  case 6: P3=Zt_fh(num,3);break;
  case 7: P3=Zt_fh(num,3)<<4;break;
  }                   //把舵機所需的電平狀態傳給p口
  Timer0(hpwm->pwm[hpwm->Cs][num-1]-hpwm->pwm[hpwm->Cs][num-2]);  //hpwm->geshu需要送人定時器hpwm->pwm【】數據個數
 }
 else
 {
  IoPH;                   //io口電平拉低
  Timer0(2500-hpwm->pwm[hpwm->Cs][hpwm->geshu[hpwm->Cs]-1]);   //將舵機pwm所需低電平時間供出
  num=0;
  hpwm->Cs>=7? hpwm->Cs=0 : ++hpwm->Cs;
 }
}  
 

關閉窗口

相關文章

主站蜘蛛池模板: 国产三区四区 | 一级在线观看 | 国产精品久久 | 日本精品免费在线观看 | 一区二区三区在线播放 | 91精品国产一区二区三区 | 黑人粗黑大躁护士 | 欧美在线免费 | 国产精品视频免费看 | 国产九九九| 国产视频福利一区 | 毛片一区二区三区 | 精品欧美黑人一区二区三区 | 风间由美一区二区三区在线观看 | 亚洲女人天堂网 | 国产精品1区 | 一区二区在线免费观看 | 日本高清视频在线播放 | 91成人在线| 午夜欧美| 超碰成人免费观看 | 在线精品一区二区三区 | 日韩中文字幕在线 | 91精品久久久 | 国产精品一区二区在线播放 | 国产黄色麻豆视频 | 日本久久网 | 影音先锋中文字幕在线观看 | 九九久久免费视频 | 91在线视频一区 | 成人福利网 | 国产精品区一区二区三区 | 四虎永久免费影院 | 爱综合 | 成人一区二区电影 | 精品一区二区电影 | 久久久99精品免费观看 | 黄色毛片黄色毛片 | 偷拍自拍网| 国产精品久久久久久久久免费丝袜 | 曰韩三级|