mg995 servo motorun puls değerlerinin hesaplama pic pro basicte

[emak_2284]

merhaba

projem için mg995 servo motor kullanıyorum. motorun puls aralığını bulmaya çalışıyorum codumu yazdım simule ederken sıkıntı var.

servo motorun puls aralığını bulmak için ilk etepta 500 mıkrosonıye verdım ve her seferınde 50 mıkro sanıye artmasını istiyorum artırdıktan sonra led yanıp sönmesini istiyorum kı motor çalışmaya başladıktan sonra kaç kere yanıp sönerse 50 ile çarpıp puls aralığını bulmayı hedeflıyorum .

ama simule ederken ıstediğimi alamıyorum led sadece bır kez yanıyor motorda -90 derece dönüp duruyor. acaba nerde hata yapıorum yardımcı olabılırmısınız ? pıc basıc pro kodum aşağıda kı gibidir. 16F877A kullanıyorum . yada elınde servo motorun pulsının bulduran kod var mı pıc basıc pro da yazılmış ? şimdiden teşekurler


PORTB=0:TRISB=%00000000
'-----------------------------------------------------------------
@ __config _XT_OSC & _WDT_ON & _PWRTE_ON & _LVP_OFF & _CP_OFF
'-----------------------------------------------------------------

A var BYTE
Y VAR BYTE
A= 500

PAUSEUS 200
'-----------------------------------------------------------------
BASLA:
For Y=0 To 39

HIGH PORTB.1

Pauseus a

LOW PORTB.1

Pauseus 20000 - A

PortB.0 = 1

Pauseus 500

A = A + 50
Next
goto BASLA