2 / 2 6 / 2 0 0 2 2 : 0 6 P M 2 / 2 6 / 2 0 0 2
9 5
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 LFIL: Load FILter Parameters
10120 GOSUB 10005 : XBY(CMDADR) = 01EH
REM Set Filter Control Word to load KP, KI, KD, and IL values
10125 DATBYTE2 = FILTCW2 : DATBYTE1 = FILTCW1 : GOSUB 10010
REM Load KP, KI, KD, and IL values
10130 DATBYTE2 = KP2 : DATBYTE1 = KP1 : GOSUB 10010
10135 DATBYTE2 = KI2 : DATBYTE1 = KI1 : GOSUB 10010
10140 DATBYTE2 = KD2 : DATBYTE1 = KD1 : GOSUB 10010
10145 DATBYTE2 = IL2 : DATBYTE1 = IL1 : GOSUB 10010
REM Issue UDF to activate changes, UDF: UpDate Filter
10149 XBY(CMDADR) = 004H : GOTO 10005
REM LTRJ: Load TRaJectory Parameters
REM This routine loads all three parameters. Therefore, the
REM Trajectory control must be set to load all three before
REM calling this routine.
10160 GOSUB 10005 : XBY(CMDADR) = 01FH : GOSUB 10005
10165 DATBYTE2 = TRAJCW2 : DATBYTE1 = TRAJCW1 : GOSUB 10010
10170 DATBYTE2 = ACCELER4 : DATBYTE1 = ACCELER3 : GOSUB 10010
10175 DATBYTE2 = ACCELER2 : DATBYTE1 = ACCELER1 : GOSUB 10010
10180 DATBYTE2 = VELOCTY4 : DATBYTE1 = VELOCTY3 : GOSUB 10010
10185 DATBYTE2 = VELOCTY2 : DATBYTE1 = VELOCTY1 : GOSUB 10010
10190 DATBYTE2 = POSITIN4 : DATBYTE1 = POSITIN3 : GOSUB 10010
10195 DATBYTE2 = POSITIN2 : DATBYTE1 = POSITIN1 : GOSUB 10010
REM Issue STT to activate changes
10199 GOTO 10099
REM RDSIGS: ReaD SIGnalS Register
10200 GOSUB 10005 : XBY(CMDADR) = 00CH : GOSUB 10005
10205 RDSIGS2 = XBY(DAT1ADR) : GOSUB 10005
10209 RDSIGS1 = XBY(DAT1ADR) : GOTO 10005
REM RDIP: ReaD Index Position
10220 GOSUB 10005 : XBY(CMDADR) = 009H : GOSUB 10005
10225 RDIP4 = XBY(DAT1ADR) : GOSUB 10005
10230 RDIP3 = XBY(DAT1ADR) : GOSUB 10005
10235 RDIP2 = XBY(DAT1ADR) : GOSUB 10005
10239 RDIP1 = XBY(DAT1ADR) : GOTO 10005
REM RDDP: ReaD Desired Position
10240 GOSUB 10005 : XBY(CMDADR) = 008H : GOSUB 10005
10245 RDDP4 = XBY(DAT1ADR) : GOSUB 10005
10250 RDDP3 = XBY(DAT1ADR) : GOSUB 10005
10255 RDDP2 = XBY(DAT1ADR) : GOSUB 10005
10259 RDDP1 = XBY(DAT1ADR) : GOTO 10005
REM RDRP: ReaD Real Position
10260 GOSUB 10005 : XBY(CMDADR) = 00AH : GOSUB 10005
10265 RDRP4 = XBY(DAT1ADR) : GOSUB 10005
10270 RDRP3 = XBY(DAT1ADR) : GOSUB 10005
10275 RDRP2 = XBY(DAT1ADR) : GOSUB 10005
10279 RDRP1 = XBY(DAT1ADR) : GOTO 10005
REM RDDV: ReaD Desired Velocity
10280 GOSUB 10005 : XBY(CMDADR) = 007H : GOSUB 10005
10285 RDDV4 = XBY(DAT1ADR) : GOSUB 10005
10290 RDDV3 = XBY(DAT1ADR) : GOSUB 10005
10295 RDDV2 = XBY(DAT1ADR) : GOSUB 10005
10299 RDDV1 = XBY(DAT1ADR) : GOTO 10005
Summary of Contents for NMIY-0031
Page 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 ...
Page 2: ...2 2 6 2 0 0 2 2 0 6 P M 2 ...
Page 6: ...2 2 6 2 0 0 2 2 0 6 P M 6 ...
Page 8: ...2 2 6 2 0 0 2 2 0 6 P M 8 ...
Page 14: ...2 2 6 2 0 0 2 2 0 6 P M 1 4 ...
Page 30: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 3 0 ...
Page 32: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 3 2 ...
Page 50: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 0 ...
Page 52: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 2 ...
Page 54: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 4 ...
Page 56: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 6 ...
Page 58: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 5 8 ...
Page 60: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 0 ...
Page 62: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 2 ...
Page 68: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 6 8 ...
Page 70: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 0 ...
Page 72: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 2 ...
Page 76: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 7 6 ...
Page 82: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 2 ...
Page 84: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 4 ...
Page 86: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 6 ...
Page 88: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 8 8 ...
Page 90: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 9 0 ...
Page 102: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 0 2 ...
Page 108: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 0 8 ...
Page 110: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 0 ...
Page 114: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 4 ...
Page 118: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 1 8 ...
Page 126: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 2 6 ...
Page 128: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 2 8 ...
Page 134: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 3 4 ...
Page 148: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 4 8 ...
Page 150: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 0 ...
Page 152: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 2 ...
Page 154: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 4 ...
Page 156: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 5 6 ...
Page 168: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 6 8 ...
Page 170: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 0 ...
Page 172: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 2 ...
Page 174: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 4 ...
Page 178: ...2 2 6 2 0 0 2 2 0 6 P M 2 2 6 2 0 0 2 1 7 8 ...