2 / 2 6 / 2 0 0 2 2 : 0 6 P M 2 / 2 6 / 2 0 0 2
9 2
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 Load Trajectory
1040 TRAJCW2 = 000H : TRAJCW1 = 000H
1045 ACCELER2 = 000H : ACCELER1 = 000H
1050 VELOCTY2 = 000H : VELOCTY1 = 000H
1055 $(0) = "Position" : GOSUB 9000
1057 POSITIN4 = I4 : POSITIN3 = I3 : POSITIN2 = I2 : POSITIN1 = I1
1060 GOSUB 9030
1075 IF(NREL)THEN TRAJCW1=(TRAJCW1.OR.002H)ELSE TRAJCW1=(TRAJCW1.OR.003H)
1080 $(0) = "Acceleration" : GOSUB 9000
1085 ACCELER4 = I2 : ACCELER3 = I1
1087 IF (ACCELER4 > VELOCTY4) THEN ACCELER4 = VELOCTY4
1088 IF (ACCELER3 > VELOCTY3) THEN ACCELER3 = VELOCTY3
1090 GOSUB 9030
1100 IF (NREL) THEN TRAJCW1 = (TRAJCW1 .OR. 020H)
1101 IF ((TRAJCW1 .AND. 020H) = 000H) THEN TRAJCW1 = (TRAJCW1 .OR. 030H)
1105 $(0) = "Velocity" : GOSUB 9000
1110 VELOCTY4 = I2 : VELOCTY3 = I1
1115 GOSUB 9030
1125 IF (NREL) THEN TRAJCW1=TRAJCW1 .OR. 008H ELSE TRAJCW1=TRAJCW1 .OR. 00CH
REM Load and activate trajectory parameters
1129 GOSUB 10160 : GOTO 105
:REM Load traj. param. and issue STT
REM Relative Move
1130 $(0) = "Position" : GOSUB 9000
1135 GOSUB 10005 : XBY(CMDADR) = 01FH
REM Send Trajectory Control Word
1136 DATBYTE2 = 000H : DATBYTE1 = 003H : GOSUB 10010
REM Send position data
1137 DATBYTE2 = I4 : DATBYTE1 = I3 : GOSUB 10010
1138 DATBYTE2 = I2 : DATBYTE1 = I1 : GOSUB 10010
REM Load and Start trajectory
1139 GOSUB 10099 : GOTO 105
REM Left Velocity Move
1150 $(0) = "Velocity" : GOSUB 9000
1153 GOSUB 10005 : XBY(CMDADR) = 01FH
REM Send Trajectory Control Word
1154 DATBYTE2 = 018H : DATBYTE1 = 028H : GOSUB 10010
REM Send Acceleration data
1155 DATBYTE2 = I2 : DATBYTE1 = I1 : GOSUB 10010
1156 DATBYTE2 = I4 : DATBYTE1 = I3 : GOSUB 10010
REM Send velocity data
1157 DATBYTE2 = I2 : DATBYTE1 = I1 : GOSUB 10010
1158 DATBYTE2 = I4 : DATBYTE1 = I3 : GOSUB 10010
REM Load and Start trajectory
1159 GOSUB 10099 : GOTO 105
REM Right Velocity Move
1170 $(0) = "Velocity" : GOSUB 9000
1173 GOSUB 10005 : XBY(CMDADR) = 01FH
REM Send Trajectory Control Word
1174 DATBYTE2 = 008H : DATBYTE1 = 028H : GOSUB 10010
REM Send Acceleration data
1175 DATBYTE2 = I2 : DATBYTE1 = I1 : GOSUB 10010
1176 DATBYTE2 = I4 : DATBYTE1 = I3 : GOSUB 10010
REM Send velocity data
1177 DATBYTE2 = I2 : DATBYTE1 = I1 : GOSUB 10010
1178 DATBYTE2 = I4 : DATBYTE1 = I3 : GOSUB 10010
REM Load and Start trajectory
1179 GOSUB 10099 : GOTO 105
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 ...