/*伸縮電機控制文件,主要實現(xiàn)伸縮電機的伸長收縮和停止動作,分別使用三個函數(shù)實現(xiàn)
    三個函數(shù)如下:
                   void Motor_Sp_En(uint duty);
                   void Motor_Sh_En(uint duty);
                   void Motor_SpSh_Stop(uint duty);
    
*/
void Motor_Sp_En(uint duty)
    {
                /*Enable those registers you will use and set the proper PWM duty*/ 
                //    PWMDTY1=0x00;//
                //    PWMDTY2=0x00;//
                //    PWMDTY3=0x00;//
                    PWMDTY01=0x05D4;
                    PWMDTY23=0x05D4;
                
                //    PWMDTY4=0x00;
                //    PTS&=0xBF;//Disable PTS_Bit6;
                //    PTS|=0x40;//Enable PTS_Bit6;
                
                //    PWMDTY5=0x00;
                //    PTS&=0x7F;//Disable PTS_Bit7;
                //    PTS|=0x80;//Enable PTS_Bit7;
                
                //    PWMDTY6=0x00;
                //    PTS&=0xDF;//Disable PTS_Bit5;
                //    PTS|=0x20;//Enable PTS_Bit5;
                
                //    PWMDTY7=duty;        
                //    PTS&=0xEF;//Disable PTS_Bit4;
                //    PTS|=0x10;//Enable PTS_Bit4;
    }
    

void Motor_Sh_En(uint duty)
    {
                /*Enable those registers you will use and set the proper PWM duty*/ 
                //    PWMDTY1=0x00;//
                //    PWMDTY2=0x00;//
                //    PWMDTY3=0x00;//
                    PWMDTY01=0x05D4;
                    PWMDTY23=0x05D4;
                
                //    PWMDTY4=0x00;
                //    PTS&=0xBF;//Disable PTS_Bit6;
                //    PTS|=0x40;//Enable PTS_Bit6;
                
                //    PWMDTY5=0x00;
                //    PTS&=0x7F;//Disable PTS_Bit7;
                //    PTS|=0x80;//Enable PTS_Bit7;
                
                //    PWMDTY6=0x00;
                //    PTS&=0xDF;//Disable PTS_Bit5;
                //    PTS|=0x20;//Enable PTS_Bit5;
                
                //    PWMDTY7=duty;        
                //    PTS&=0xEF;//Disable PTS_Bit4;
                //    PTS|=0x10;//Enable PTS_Bit4;
    }

void Motor_SpSh_Stop(uint duty)
    {
                /*Enable those registers you will use and set the proper PWM duty*/ 
                //    PWMDTY1=0x00;//
                //    PWMDTY2=0x00;//
                //    PWMDTY3=0x00;//
                    PWMDTY01=0x05D4;
                    PWMDTY23=0x05D4;
                
                //    PWMDTY4=0x00;
                //    PTS&=0xBF;//Disable PTS_Bit6;
                //    PTS|=0x40;//Enable PTS_Bit6;
                
                //    PWMDTY5=0x00;
                //    PTS&=0x7F;//Disable PTS_Bit7;
                //    PTS|=0x80;//Enable PTS_Bit7;
                
                //    PWMDTY6=0x00;
                //    PTS&=0xDF;//Disable PTS_Bit5;
                //    PTS|=0x20;//Enable PTS_Bit5;
                
                //    PWMDTY7=duty;        
                //    PTS&=0xEF;//Disable PTS_Bit4;
                //    PTS|=0x10;//Enable PTS_Bit4;
    }