怎么用pic16F1825控制伺服电机？

大家好，我想用pic16F1825控制伺服电机（Futaba 3003），我不能使周期20ms，我用adc控制工作量，有人能帮我编程：#pragma config FOSC=HS//振荡器选择位（HS振荡器）#pragma config WDTE=OFF//Watchdog timer Enable位（WDT禁用）#pragma config PWRTE=ON//上电定时器使能位（启用了PWRT）pragma co nfig BOREN=OFF//Brown-out Reset Enable位（禁用了BOR）pragma co nfig LVP=ON//低压（单电源）电路内串行编程使能位（RB3/PGM管脚具有PGM功能；启用了低压编程）\pragma config CPD=OFF//Data EEPROM内存代码保护位（数据EEPROM代码保护关闭）#pragma配置WRT=OFF//Flash程序存储器写启用位（写保护关闭；所有程序存储器可以由EECON控制写入）#pragma配置CP=OFF//Flash程序存储器代码保护b代码（代码保护关闭）定义_XTAL_FREQ 20000000定义TMR2PRESCALE 4定义TMR2PRESCALE 4定义\定义\\\定义\XTAL_XTAL_FREQ200000000000000000000000000000000000000000000000000000000000定义\\定义TMR2定义TMR2PRESCAL川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川川P4M2=1;T21；T2CKPS1=1；TMR2PS1=1；TMR2ON=1；//配置定时器模块TRISC1=0；}PWM_Duty(无符号整税){如果(责任< 1023){如果_(责任< 1023){占=((浮动)占/1023)*(_XTAL_占=((PWM_freq*TMR2*TMR2PRESCXXTAL_FREQ/(PWM_Freq___*TMR2PRESCFREQ))；(DCTAL_XTAL_XTAL_FRTAL_FREQ/(PWM_FFFFFFFFFFFFFFFFFFFQTMR2*TMR2PRESCR2void ADC_Initialize(){ADCON0=0b0000001; //ADC ON和Fosc/16被选择为ADCON1=0b11010000;}在ADC_Read(无符号字符信道){ADCON0&=0x11000101;//清除信道选择位ADCON0|=.<3;//设置所需的位_u._ms(2);GO_nDONE=1;//在(GO_nDONE);/初始化A/D转换时/等待A/D转换完成返回((ADRESH<<8)+ADRESL)；//Returns Result}void main(){int adc_value;int pot；TRISC=0x00；//PORTC作为输出TRISA=0xFF；//PORTA作为输入//TRISD=0x00；ADC_Initialize()；//Initializes ADC模块PWM_Initialize()；//这设置PWM频率PWM1do{adc_value=ADC_Read(0)；u._ms(5)；//读取模拟信道0 PWM_Duty(adc_value)；u._ms(50)；}.(1)；//无限循环}