智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 1975|回复: 1
打印 上一主题 下一主题

[软件类] 这里有个舵机调试程序,求大神解读,表示看不懂

[复制链接]

37

主题

179

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1223

活跃会员奖章优秀会员奖章

威望
674
贡献
309
兑换币
361
注册时间
2014-2-27
在线时间
120 小时
跳转到指定楼层
1#
发表于 2014-4-17 20:18:45 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
这是红树伟业发来的   但是我真心没弄懂里面两个PWMDTY是怎么弄的   调试舵机的转角要用哪个占空比  难道1611之石作为中间位置的基准占空比吗   中断里面的才是调角度的?






#include <hidef.h>      /* common defines and macros */#include <MC9S12XS128.h>     /* derivative information */
#pragma LINK_INFO DERIVATIVE "mc9s12xs128"

unsigned char RX=0,temp0;


void uart_putchar(unsigned char ch)
{
  if (ch == '\n')  
  {
      while(!(SCI0SR1&0x80)) ;     
      SCI0DRL= 0x0d;            
     return;
  }
  while(!(SCI0SR1&0x80)) ;      
  SCI0DRL=ch;
}

static void PWM_Init(void)
{     
    //SB,B for ch2367
    //SA,A for ch0145   
      
    PWMCTL_CON01=1;                  //0和1联合成16位PWM;
    PWMCAE_CAE1=0;                        //选择输出模式为左对齐输出模式
    PWMCNT01 = 0;                                //计数器清零;
    PWMPOL_PPOL1=1;                        //先输出高电平,计数到DTY时,反转电平
    PWMPRCLK = 0X40;    //clockA不分频,clockA=busclock=16MHz;CLK B 16分频:1Mhz   
    PWMSCLA = 8;        //对clock SA 进行2*8=16分频;pwm clock=clockA/16=1MHz;     
    PWMCLK_PCLK1 = 1;   //选择clock SA做时钟源
    PWMPER01  =  20000;   //周期20ms; 50Hz;(可以使用的范围:50-200hz)
    PWMDTY01  =  1611;   //高电平时间为1.5ms;  
    PWME_PWME1 = 1;        
}

void setbusclock(void)   //PLL setting
{   
    CLKSEL=0X00;    //disengage PLL to system
    PLLCTL_PLLON=1;   //turn on PLL
    SYNR=1;         
    REFDV=1;          //pllclock=2*osc*(1+SYNR)/(1+REFDV)=32MHz;
    _asm(nop);          //BUS CLOCK=16M
    _asm(nop);
    while(!(CRGFLG_LOCK==1));   //when pll is steady ,then use it;
    CLKSEL_PLLSEL =1;          //engage PLL to system;
}

static void SCI_Init(void)  //SCI
{
    SCI0CR1=0x00;
    SCI0CR2=0x2c; //enable Receive Full Interrupt,RX enable,Tx enable
    SCI0BDH=0x00; //busclk  8MHz,19200bps,SCI0BDL=0x1a
    SCI0BDL=0x68; //SCI0BDL=busclk/(16*SCI0BDL)                  
                  //busclk 16MHz, 9600bps,SCI0BDL=0x68                  
}

interrupt 20 void SCI_Rx_IRS(void)    //中断接收
{
    unsigned char  RxData;
    DisableInterrupts;
    if  (SCI0SR1&0x20)
    {
        
       RxData = SCI0DRL;  
         
       switch(RX)
       {
          case 0:
            if (RxData==0xfe) RX=1;
            break;
          case 1:
            temp0 = RxData;
            RX=2;
            break;
          case 2:
             PWMDTY01= ((unsigned int)temp0 <<8)|RxData;
             PORTB=~PORTB;
             RX=0;
             break;           
       }
        uart_putchar(RxData);
    }   
    EnableInterrupts;      
}

void main(void)
{
  EnableInterrupts;
  setbusclock();
  SCI_Init();
  PWM_Init();
  DDRM=0XFF;
  PTM=0X10;
  DDRB=0xff;
  for(;;)   {
  }
}  这个舵机程序要怎么测试舵机  求   真的不知道里面两个PWMDTY01都是干什么的

回复

使用道具 举报

0

主题

2

帖子

0

精华

注册会员

Rank: 2

积分
25
威望
15
贡献
8
兑换币
7
注册时间
2015-4-6
在线时间
1 小时
2#
发表于 2015-4-19 20:26:56 | 只看该作者
PWMDTY01是PTP口的P1口和P2口级联后的占空比设置寄存器,通过改变PWMDTY01来改变占空比
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-9-21 13:41 , Processed in 0.050936 second(s), 35 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表