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
Содержание 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 ...