New Micros NMIY-0031, Manual

Page: 89 / 188

2 / 2 6 / 2 0 0 2 2 : 0 6 P M 2 / 2 6 / 2 0 0 2 8 9
N M I L - 7 0 4 0 S T E P P E R M O T O R C O N T R O L L E R
B A S I C S A M P L E P R O G R A M
NEW
REM The NMIL-7040 stepper motor controller can be with the NMIY-0031
REM processor board to implement a stepper motor control system. This
REM program illustrates the commands used to control a stepper in such
REM a system. The program uses 0FFE0H as the address of the NMIL-7040.
REM
REM Initialize Parameters
REM No initialization of the NMIL-7040 is needed. In an actual system,
REM it may be desirable to position the motor to an initial starting
REM position.
10 DUMMY = 17 : REM Used by delay loop
20 DELAY = 4 : REM Number of times through delay loop
30 MNUMBER = 1 : REM Motor number
40 DIRECT = 1 : REM Motor direction
50 STEEPS = 10 : REM Number of steps to make in one move
60 BASEADR = 0FFE0H : REM Base address of NMIL-7040
100 PRINT " 0 Enter a motor to control (1-4, default = 1)"
110 PRINT " 1 Change motor direction (default = CW)"
120 PRINT " 2 Enter the number of steps to move"
130 PRINT " 3 Issue motor command"
140 PRINT " 4 Put motor in search mode (does not return to menu)"
150 INPUT " Enter the number of your selection: ", CHOICE
160 ON (CHOICE) GOTO 200, 210, 220, 300, 500
REM Get motor number and check range
200 INPUT "Enter a motor number (1, 2, 3, 4) to control: ", MNUMBER
205 IF ((MNUMBER < 1) .OR. (MNUMBER > 4)) THEN MNUMBER = 1 ELSE GOTO 100
REM Flip direction bit
210 DIRECT = DIRECT .XOR. 1 : GOTO 100
REM Get number of steps and check range
220 INPUT "Enter the number (positive integer) of steps to make: ", STEEPS
225 IF (STEEPS < 1) THEN STEEPS = 10 ELSE GOTO 100
REM Lines 300 to 350 use MNUMBER (motor number) and REGMASK
REM to generate the output data for controlling the selected motor.
REM DIRECT is used to set the direction of motor rotation.
300 REGMASK = 2
310 IF (MNUMBER = 1) THEN GOTO 350
320 FOR I = 2 TO MNUMBER
330 REGMASK = REGMASK * 4
340 NEXT I
350 COMMND = R ((REGMASK/2)*DIRECT)
REM Lines 360 to 420 then toggle the step line for the selected motor
REM the requested number of times. Lines 1070 and 1090 are delays.
360 FOR I = 1 TO STEEPS
370 XBY(BASEADR) = COMMND
380 FOR J = 1 TO DELAY : NEXT J
390 XBY(BASEADR) = COMMND .XOR. REGMASK
400 FOR J = 1 TO DELAY : NEXT J
410 NEXT I
420 IF (CHOICE = 4) THEN GOTO 510 ELSE GOTO 100
REM Setup for nearly 1 revolution with fast response, then loop forever
500 STEEPS = 200 : DELAY = 3
510 DIRECT = DIRECT .XOR. 01H
520 GOTO 300