Program for SD21 Servodriver

moppa

New Member
wath is wrong wisch this program found on page 6 (Technical Specification from SD21_21 Channel Servo Driver Module)


Servo1 = 63 ' servo 1 base register
Servo1p = 84 ' servo 1 positive offset register
Servo1n = 105 ' servo 1 negative offset register
Base = 128 ' centre position
Offset = 50 ' +/- 50 from centre position
ProgStart:
writei2c Servo1, (Base)
Loop:
writei2c Servo1p, (Offset)
pause 300
writei2c Servo1n, (Offset)
pause 300
goto Loop
Thanks,
Jack




 
 

eclectic

Moderator
<code><pre><font size=2 face='Courier'>
symbol Servo1 = 63 ' servo 1 base register
symbol Servo1p = 84 ' servo 1 positive offset register
symbol Servo1n = 105 ' servo 1 negative offset register
symbol Base = 128 ' centre position
symbol Offset = 50 ' +/- 50 from centre position

ProgStart:
i2cslave $c2, i2cslow, i2cbyte ' setup i2c port for servo controller
writei2c Servo1, (Base)

Loop: writei2c Servo1p, (Offset)
pause 300
writei2c Servo1n, (Offset)
pause 300
goto Loop
</font></pre></code>

e.



Edited by - eclectic on 20/11/2006 19:53:26
 
Top