2 / 2 6 / 2 0 0 2 2 : 0 6 P M 2 / 2 6 / 2 0 0 2
9 4
N M I L - 7 0 5 6 S E R V O M O T O R D R I V E R
B A S I C S A M P L E P R O G R A M
REM Low Level Routines
REM Get status and Reset Interrupts
10000 STATUS = XBY(CMDADR) : RETURN
REM Reset Interrupts
10001 GOSUB 10005 : XBY(CMDADR) = 01DH : GOSUB 10005
10002 DATBYTE2 = 000H : DATBYTE1 = 000H : GOSUB 10010 : RETURN
REM Wait for cleared Busy Bit
REM This subroutine is used as a return by multiple entry points
10005 DO
10006 GOSUB 10000
:REM Read status port
10007 UNTIL ( (STATUS .AND. 01H) = 000H )
10009 RETURN
REM Write double byte and check for cleared busy bit
10010 GOSUB 10005
10012 XBY(DAT1ADR) = DATBYTE2 : XBY(DAT1ADR) = DATBYTE1
10016 GOSUB 10005
10019 RETURN
REM Read double byte and check for cleared busy bit
10020 GOSUB 10005
10022 DATBYTE2 = XBY(DAT1ADR)
10024 GOSUB 10005
10026 DATBYTE1 = XBY(DAT1ADR)
10029 RETURN
REM Stop & wait for move end
10030 GOSUB 10005
10032 XBY(CMDADR) = 01FH
10035 DATBYTE2 = 002H
10036 DATBYTE1 = 000H : GOSUB 10010
REM Issue STT to activate motor stop command
10037 GOSUB 10005
10038 XBY(CMDADR) = 001H
REM Wait For Move End
10040 DO
10045 TEMP = XBY(CMDADR) .AND. 004H
10050 GOSUB 10005
10055 UNTIL ( TEMP )
10059 RETURN
REM Motor ON
REM Clear Trajectory Control Word
10090 GOSUB 10005
10092 XBY(CMDADR) = 01FH
10093 GOSUB 10005
10095 BYTE2 = 000H
10096 BYTE1 = 000H
10097 GOSUB 10010
REM STT: STarT Motor Command
10099 GOSUB 10005 : XBY(CMDADR) = 001H : GOTO 10005
REM DFH: DeFine Home
10100 GOSUB 10005 : XBY(CMDADR) = 002H : GOTO 10005
REM SIP: Set Index Position
10110 GOSUB 10005 : XBY(CMDADR) = 003H : GOTO 10005
Содержание NMIY-0031
Страница 1: ...2 2 6 2 0 0 2 2 0 6 P M 1 NMIY 0031 Single Board Computer Covers NMIY 0031 V1 0 4 22 96 ...
Страница 2: ...2 2 6 2 0 0 2 2 0 6 P M 2 ...
Страница 6: ...2 2 6 2 0 0 2 2 0 6 P M 6 ...
Страница 8: ...2 2 6 2 0 0 2 2 0 6 P M 8 ...
Страница 14: ...2 2 6 2 0 0 2 2 0 6 P M 1 4 ...
Страница 30: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 3 0 ...
Страница 32: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 3 2 ...
Страница 50: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 0 ...
Страница 52: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 2 ...
Страница 54: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 4 ...
Страница 56: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 6 ...
Страница 58: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 8 ...
Страница 60: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 0 ...
Страница 62: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 2 ...
Страница 68: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 8 ...
Страница 70: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 0 ...
Страница 72: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 2 ...
Страница 76: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 6 ...
Страница 82: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 2 ...
Страница 84: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 4 ...
Страница 86: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 6 ...
Страница 88: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 8 ...
Страница 90: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 9 0 ...
Страница 102: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 0 2 ...
Страница 108: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 0 8 ...
Страница 110: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 0 ...
Страница 114: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 4 ...
Страница 118: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 8 ...
Страница 126: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 2 6 ...
Страница 128: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 2 8 ...
Страница 134: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 3 4 ...
Страница 148: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 4 8 ...
Страница 150: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 0 ...
Страница 152: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 2 ...
Страница 154: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 4 ...
Страница 156: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 6 ...
Страница 168: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 6 8 ...
Страница 170: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 0 ...
Страница 172: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 2 ...
Страница 174: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 4 ...
Страница 178: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 8 ...