電子工程師教你：做一個屬于自己的怠速馬達(dá)驅(qū)動器 - 全文

　　__CONFIG(0x3194);

　　#define uint unsigned int

　　#define uchar unsigned char

　　void zhen();

　　void fan();

　　void init();

　　void delay(uint x)

　　{

　　uint a,b;

　　for(a=x;a>0;a--)

　　for(b=110;b>0;b--);

　　}

　　void main()

　　{

　　uchar w;

　　delay(20);

　　init();

　　while(1)

　　{

　　if(GPIO5==0)

　　{

　　delay(10);

　　if(GPIO5==0)

　　{

　　for(w=5;w>0;w--)

　　zhen();

　　}

　　}

　　if(GPIO3==0)

　　{

　　delay(10);

　　if(GPIO3==0)

　　{

　　for(w=5;w>0;w--)

　　fan();

　　}

　　}

　　}

　　}

　　void init()

　　{

　　TRISIO=0b00101000;

　　CMCON=0X07;

　　GPPU=0;

　　WPU5=1;

　　GPIO=0B00111111;

　　}

　　void zhen()

　　{

　　GPIO=0X0F;

　　delay(80);

　　GPIO=0XFd;

　　delay(80);

　　GPIO=0XFb;

　　delay(80);

　　GPIO=0XFE;

　　delay(80);

　　GPIO=0XFF;

　　}

　　void fan()

　　{

　　GPIO=0Xfe;

　　delay(80);

　　GPIO=0XFb;

　　delay(80);

　　GPIO=0XFd;

　　delay(80);

　　GPIO=0X0f;

　　delay(80);

　　GPIO=0XFF;

　　}