關於伺服機馬達

我的目的是 我想要控制伺服機馬達 利用中斷 每10ms檢查一次
然後設一個暫存器 =CR1
CR1=10 給他做 CR1--動作 數到0時p1這隻IO腳輸出便0
然後同時也讓count做--動作 數到0時CR1回變為0 我以下寫法有錯誤嗎?
p1=IO
計時器啟動--->p1=MCR1;
MCR1=CR1
中斷
count=20;CR1=10;
if(count!=0){count--;}
if(CR1!=0){CR1--;}
else if(CR1=0){p1t=0;}
else if(count=0){CR1=10;count=20;}
為什麼這樣寫 波行始終為1?