dcmotor.c

uccos2的的源码文件

#include "2410addr.h"
#include "2410lib.h"
#include "timer.h"
#include "myDef.h"


/*********************************************************************************************************
** Function name: DelayNS
** Descriptions : 软件延时  **延时时间与系统时钟有关**
** Input : dly
** Output: -
** Created Date: 2007-8-2 09:53上午
********************************************************************************************************/
void  DelayNS(uint32  dly)
{
    uint32  i;

    for(; dly>0; dly--)
       for(i=0; i<50000; i++);
}


/*********************************************************************************************************
** Function name: PWM_Init
** Descriptions : 初始化PWM定时器 @ FCLK=200MHz,HCLK=100MHz,PCLK=50MHz
** Input : cycle, PWM周期控制值(uint16类型)
**         duty, PWM占空比(uint16类型)
** Output: -
** Created Date : 2007-8-2 03:24下午
********************************************************************************************************/
void  PWM_Init(uint16 cycle, uint16 duty)
{
    if(duty>cycle) duty = cycle;    // 占空比需要小于等于周期

    rTCFG0 = 97;                    // 8位预分频器做97+1分频，50MHz/(97+1)=510,204Hz
    rTCFG1 = 0;                     // 分频器选择1/2分频，510,204Hz/2 =255,102Hz
    rTCMPB0 = duty;                 // 设置PWM占空比
    rTCNTB0 = cycle;                // 设置PWM周期
    if(rTCON&0x04) rTCON = (1<<1);  // 更新定时器数据 (取反输出inverter位)
      else  rTCON = (1<<2)|(1<<1);
    rTCON = (1<<0)|(1<<3);          // 启动定时器
}



/*********************************************************************************************************
** Function name: DCmotorTest
** Descriptions : 通过timer0的PWM功能，控制直流电机。
**                pins: GPB0/TOUT0, GPH9
** Input : -
** Output: -
** Created Date : 2007-8-2 03:49下午
********************************************************************************************************/
//void DCmotorTest(void)
//{
//    uint16  pwm_duty;
//
//    // TOUT0口设置
//    rGPBCON = (rGPBCON & (~(0x03<<0))) | (0x02<<0);     // rGPBCON[1:0] = 10b，设置TOUT0功能
//    rGPBUP = rGPBUP | 0x0001;                           // 禁止TOUT0口的上拉电阻
//
//    // 设置GPH9为GPIO输出模式
//    rGPHCON = (rGPHCON & (~(0x03<<18))) | (0x01<<18);   // GPH9口
//    rGPHDAT = rGPHDAT & (~(1<<9));                      // 输出0电平
//    rGPHUP  = rGPHUP | (1<<9);
//
//    // 初始化PWM输出。
//    PWM_Init(255, 60);  //cycle, duty
//    puts("\nDC motor is running, press ESC key to exit!\n");
//
//    while(1)
//    {
//        puts("Speed up!\n");
//        for(pwm_duty=50; pwm_duty<=200; pwm_duty=pwm_duty+10)
//        {
//            rTCMPB0 = pwm_duty;
//            DelayNS(250);
//            if(getkey()==0x1b) goto StopRun;
//        }
//
//        puts("Speed down!\n");
//        for(pwm_duty=200; pwm_duty>=50; pwm_duty=pwm_duty-10)
//        {
//            rTCMPB0 = pwm_duty;
//            DelayNS(250);
//            if(getkey()==0x1b) goto StopRun;
//        }
//    }
//
//StopRun:
//    rTCON &= 0xFFF0;    // stop PWM
//    rGPBCON = (rGPHCON & (~(0x03<<0))) | (0x01<<0);     // GPB0口
//    rGPBDAT = rGPHDAT & (~(1<<0));                      // 输出0电平
//    rGPBUP  = rGPHUP | (1<<0);
//}


void DCmotorTest(void)
{
    // TOUT0口设置
    rGPGCON = (rGPGCON & (~(0x03<<22))) | (0x01<<22);   // rGPBCON[1:0] = 10b，设置TOUT0功能
    rGPGUP = rGPGUP | (1<<11);                          // 禁止TOUT0口的上拉电阻
    rGPGDAT |= (1<<11);                                 // 输出1电平

    // 设置GPH9为GPIO输出模式
    rGPHCON = (rGPHCON & (~(0x03<<18))) | (0x01<<18);   // GPH9口
    rGPHUP  = rGPHUP | (1<<9);
    rGPHDAT &= (~(1<<9));                               // 输出0电平

    puts("\nDC motor is running, press ESC key to exit!\n");

    while(1)
    {
        if(getkey()==0x1b)
        {
            rGPGCON = (rGPGCON & (~(0x03<<22))) | (0x02<<22);     // rGPBCON[1:0] = 10b，设置TOUT0功能
            rGPGUP = rGPGUP | (1<<11);                  // 禁止TOUT0口的上拉电阻
            rGPGDAT &= ~(1<<11);                        // 输出0电平
            break;
        }
    }
}

/* end of file */