Import LinuxCNC source tree

tests/mdi-queue-length/.gitignore

@@ -0,0 +1 @@
+sim.var.bak

tests/mdi-queue-length/README

@@ -0,0 +1,3 @@
+
+This test verifies some of Motion's Status variables.
+

tests/mdi-queue-length/checkresult

@@ -0,0 +1,2 @@
+#!/bin/sh
+exit 0 # test failure is indicated by test.sh exit value

tests/mdi-queue-length/core_sim.hal

@@ -0,0 +1,59 @@
+# core HAL config file for simulation
+
+# first load all the RT modules that will be needed
+# kinematics
+loadrt [KINS]KINEMATICS
+# motion controller, get name and thread periods from INI file
+loadrt [EMCMOT]EMCMOT base_period_nsec=[EMCMOT]BASE_PERIOD servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[KINS]JOINTS
+# load 6 differentiators (for velocity and accel signals
+loadrt ddt count=6
+# load additional blocks
+loadrt hypot count=2
+loadrt comp count=3
+loadrt or2 count=1
+
+# add motion controller functions to servo thread
+addf motion-command-handler servo-thread
+addf motion-controller servo-thread
+# link the differentiator functions into the code
+addf ddt.0 servo-thread
+addf ddt.1 servo-thread
+addf ddt.2 servo-thread
+addf ddt.3 servo-thread
+addf ddt.4 servo-thread
+addf ddt.5 servo-thread
+addf hypot.0 servo-thread
+addf hypot.1 servo-thread
+
+# create HAL signals for position commands from motion module
+# loop position commands back to motion module feedback
+net Xpos joint.0.motor-pos-cmd => joint.0.motor-pos-fb ddt.0.in
+net Ypos joint.1.motor-pos-cmd => joint.1.motor-pos-fb ddt.2.in
+net Zpos joint.2.motor-pos-cmd => joint.2.motor-pos-fb ddt.4.in
+
+# send the position commands thru differentiators to
+# generate velocity and accel signals
+net Xvel ddt.0.out => ddt.1.in hypot.0.in0
+net Xacc <= ddt.1.out
+net Yvel ddt.2.out => ddt.3.in hypot.0.in1
+net Yacc <= ddt.3.out
+net Zvel ddt.4.out => ddt.5.in hypot.1.in0
+net Zacc <= ddt.5.out
+
+# Cartesian 2- and 3-axis velocities
+net XYvel hypot.0.out => hypot.1.in1
+net XYZvel <= hypot.1.out
+
+# estop loopback
+net estop-loop iocontrol.0.user-enable-out iocontrol.0.emc-enable-in
+
+# create signals for tool loading loopback
+net tool-prepare <= iocontrol.0.tool-prepare
+net tool-prepared => iocontrol.0.tool-prepared
+
+net tool-change <= iocontrol.0.tool-change
+net tool-changed => iocontrol.0.tool-changed
+
+net tool-number <= iocontrol.0.tool-number
+net tool-prep-number <= iocontrol.0.tool-prep-number
+net tool-prep-pocket <= iocontrol.0.tool-prep-pocket

tests/mdi-queue-length/test-ui.py

@@ -0,0 +1,120 @@
+#!/usr/bin/env python3
+
+import linuxcnc
+import hal
+
+import math
+import time
+import sys
+import subprocess
+import os
+import signal
+import glob
+import re
+
+
+def wait_for_linuxcnc_startup(status, timeout=10.0):
+
+    """Poll the Status buffer waiting for it to look initialized,
+    rather than just allocated (all-zero).  Returns on success, throws
+    RuntimeError on failure."""
+
+    start_time = time.time()
+    while time.time() - start_time < timeout:
+        status.poll()
+        if (status.angular_units == 0.0) \
+            or (status.axis_mask == 0) \
+            or (status.cycle_time == 0.0) \
+            or (status.exec_state != linuxcnc.EXEC_DONE) \
+            or (status.interp_state != linuxcnc.INTERP_IDLE) \
+            or (status.inpos == False) \
+            or (status.linear_units == 0.0) \
+            or (status.max_acceleration == 0.0) \
+            or (status.max_velocity == 0.0) \
+            or (status.program_units == 0.0) \
+            or (status.rapidrate == 0.0) \
+            or (status.state != linuxcnc.RCS_DONE) \
+            or (status.task_state != linuxcnc.STATE_ESTOP):
+            time.sleep(0.1)
+        else:
+            # looks good
+            return
+
+    # timeout, throw an exception
+    raise RuntimeError
+
+
+def wait_for_mdi_queue(queue_len, timeout=10):
+    start_time = time.time()
+    while (time.time() - start_time) < timeout:
+        s.poll()
+        if s.queued_mdi_commands == queue_len:
+            return
+        time.sleep(0.1)
+    print("queued_mdi_commands at %d after %.3f seconds" % (s.queued_mdi_commands, timeout))
+    sys.exit(1)
+
+
+c = linuxcnc.command()
+s = linuxcnc.stat()
+e = linuxcnc.error_channel()
+
+
+h = hal.component("test-ui")
+h.newpin("digital-poker", hal.HAL_BIT, hal.HAL_OUT)
+h['digital-poker'] = False
+h.ready()
+
+hal.new_sig('poke', hal.HAL_BIT)
+hal.connect('motion.digital-in-00', 'poke')
+hal.connect('test-ui.digital-poker', 'poke')
+
+
+# Wait for LinuxCNC to initialize itself so the Status buffer stabilizes.
+wait_for_linuxcnc_startup(s)
+
+c.state(linuxcnc.STATE_ESTOP_RESET)
+c.state(linuxcnc.STATE_ON)
+c.home(-1)
+c.wait_complete()
+
+c.mode(linuxcnc.MODE_MDI)
+
+# At startup there's nothing in the queue.
+s.poll()
+assert(s.queued_mdi_commands == 0)
+
+# Block Motion from draining the queue, by asking it to wait for us to
+# poke a synchronized digital input.  Wait up to 30 seconds for digital
+# input 0 to go High.
+c.mdi('m66 p0 l3 q30')
+
+s.poll()
+assert(s.queued_mdi_commands == 0)
+
+# Put an MDI command on Task's MDI queue.
+c.mdi('g4 p0')
+
+s.poll()
+assert(s.queued_mdi_commands == 1)
+
+# Add another MDI command that we can control.
+# Wait up to 30 seconds for digital input 0 to go Low.
+c.mdi('m66 p0 l4 q30')
+
+s.poll()
+assert(s.queued_mdi_commands == 2)
+
+c.mdi('g4 p0')
+
+s.poll()
+assert(s.queued_mdi_commands == 3)
+
+h['digital-poker'] = True
+wait_for_mdi_queue(queue_len=1, timeout=10)
+
+h['digital-poker'] = False
+wait_for_mdi_queue(queue_len=0, timeout=10)
+
+sys.exit(0)
+

tests/mdi-queue-length/test.ini

@@ -0,0 +1,101 @@
+[EMC]
+VERSION = 1.1
+DEBUG = 0xffffffff
+
+[DISPLAY]
+DISPLAY = ./test-ui.py
+
+[RS274NGC]
+PARAMETER_FILE = sim.var
+USER_M_PATH = ./subs
+
+[EMCMOT]
+EMCMOT = motmod
+COMM_TIMEOUT = 4.0
+BASE_PERIOD = 0
+SERVO_PERIOD = 1000000
+
+[TASK]
+TASK = milltask
+CYCLE_TIME = 0.001
+
+[HAL]
+HALUI = halui
+HALFILE = core_sim.hal
+
+[TRAJ]
+NO_FORCE_HOMING=1
+AXES =                  3
+COORDINATES =           X Y Z
+HOME =                  0 0 0
+LINEAR_UNITS =          inch
+ANGULAR_UNITS =         degree
+DEFAULT_LINEAR_VELOCITY =      1.2
+MAX_LINEAR_ACCELERATION =      123.45
+MAX_LINEAR_VELOCITY =          45.67
+
+[EMCIO]
+TOOL_TABLE = simpockets.tbl
+TOOL_CHANGE_QUILL_UP = 1
+RANDOM_TOOLCHANGER = 0
+
+[KINS]
+KINEMATICS = trivkins
+JOINTS = 3
+
+[AXIS_X]
+MIN_LIMIT = -40.0
+MAX_LIMIT = 40.0
+MAX_VELOCITY = 4
+MAX_ACCELERATION = 1000.0
+
+[JOINT_0]
+TYPE =             LINEAR
+HOME =             0.000
+MAX_VELOCITY =     4
+MAX_ACCELERATION = 1000.0
+BACKLASH =         0.000
+INPUT_SCALE =      4000
+OUTPUT_SCALE =     1.000
+MIN_LIMIT =        -40.0
+MAX_LIMIT =        40.0
+FERROR =           0.050
+MIN_FERROR =       0.010
+
+[AXIS_Y]
+MIN_LIMIT = -40.0
+MAX_LIMIT = 40.0
+MAX_VELOCITY = 4
+MAX_ACCELERATION = 1000.0
+
+[JOINT_1]
+TYPE =             LINEAR
+HOME =             0.000
+MAX_VELOCITY =     4
+MAX_ACCELERATION = 1000.0
+BACKLASH =         0.000
+INPUT_SCALE =      4000
+OUTPUT_SCALE =     1.000
+MIN_LIMIT =        -40.0
+MAX_LIMIT =        40.0
+FERROR =           0.050
+MIN_FERROR =       0.010
+
+[AXIS_Z]
+MIN_LIMIT = -40.0
+MAX_LIMIT = 40.0
+MAX_VELOCITY = 4
+MAX_ACCELERATION = 1000.0
+
+[JOINT_2]
+TYPE =             LINEAR
+HOME =             0.0
+MAX_VELOCITY =     4
+MAX_ACCELERATION = 1000.0
+BACKLASH =         0.000
+INPUT_SCALE =      4000
+OUTPUT_SCALE =     1.000
+MIN_LIMIT =        -40.0
+MAX_LIMIT =        40.0
+FERROR =           0.050
+MIN_FERROR =       0.010

tests/mdi-queue-length/test.sh

@@ -0,0 +1,5 @@
+#!/bin/bash
+
+rm -f sim.var
+linuxcnc -r test.ini
+