motor.c

ARM7下用图形用户界面实现LED,KEY,MOTOR,AD功能

#include "hardware.h"
#include "motor.h"
                                                                                
void init_MotorPort()
{
        TCFG0|=(0<<24)|2;
                                                                                
        //divider timer0=1/2;
        TCFG1&=(~0xf);
        TCNTB0= MOTOR_CONT;
        TCMPB0= MOTOR_MID;
        TCON|=0x2;              
        TCON&=~0x2;
        TCON|=0x19;
                                                                                
}
                                                                                
void SetPWM(int value)
{
        TCMPB0= MOTOR_MID+value*MOTOR_CONT/1024;
}

void exit_MotorPort(void)
{
        TCON&=~0x1f;
}