Mach3 Plugin - with Encoders

 

 

The following describes the use of linear glass scale encoders or rotary shaft encoders with Mach3.  The setup process described apply for KFlop operating in open loop mode with encoders as well as closed loop control.

 

KFlop/KMotion should first be wired and configured such that the encoders are functional and scaled (using the InputGain0 parameter) so that the encoder counts match the commanded position in units of μsteps.  To verify that this is properly configured the KMotion.exe Step Response Screen may be used for verification.  The Plot of Position Error should show small errors (typically <200 μSteps) for a Move Plot if properly configured.

 

Since the encoder position is already scaledwithin KFlop/KMotion  to match the μsteps/Unit scale of the motor, the Mach3 Encoder resolution should be set to the same value as the Motor "Tuning" as shown below.  The Encoder/MPG screen is opened using the Config|Ports and Pins Menu.  The Port and Pin definitions are not relevant when using KMotion/KFlop and should be set to some unused Port.

 

 

 

 

 

 

Zero Buttons

 

Mach3 "Zeros" a DRO by adjusting the currently selected work offset such that the DRO will read zero.  Since the glass scales are the best reference,  the commanded position is adjusted to match the encoder position, before Mach3 is told to compute the new work offset.

 

NotifyPlugins(10100)       'tell KFlop to set command to encoder
Sleep 300                         'make sure mach updates
DoOEMButton (1008)     'calculate work offset
 

 

 

NotifyPlugins(10101)       'tell KFlop to set command to encoder
Sleep 300                         'make sure mach updates
DoOEMButton (1009)     'calculate work offset

 

 

 

 

NotifyPlugins(10102)       'tell KFlop to set command to encoder
Sleep 300                         'make sure mach updates
DoOEMButton (1010)     'calculate work offset

 

 

 

 

In the Config|Config Plugins|Dynomotion set an appropriate KFlop User Program that will process the NotifyPlugin Message Codes to set KFlops internal Commanded Destination to the Current Encoder Positions.  Typical program for 3 axes shown below.  Note that the Message code is defined to be passed to the KFlop User Program via persist.UserData[6]

 

 

 

 

Example File: <Install Dir>\C Programs\NotifyZeroEncoderMach3.c

#include "KMotionDef.h"

//Plugin calls for Mach3 NotifyPlugins Commands

#define X 0
#define Y 1
#define Z 2

main()
{
    int msg = persist.UserData[6]; // Mach3 notify Message 10000-10999

    printf("Mach3 Notify Call, Message = %d\n",msg);

    if (msg==10100)
    {
        // adjust the commanded position to match the glass scale encoder
        DisableAxis(X);
        EnableAxisDest(X,chan[X].Position);
    }
    if (msg==10101)
    {
        // adjust the commanded position to match the glass scale encoder
        DisableAxis(Y);
        EnableAxisDest(Y,chan[Y].Position);
    }
    if (msg==10102)
    {
        // adjust the commanded position to match the glass scale encoder
        DisableAxis(Z);
        EnableAxisDest(Z,chan[Z].Position);
    }
}

 

REF Buttons

 

Mach3 REF buttons are used to set the initial Machine coordinates either by simply Zeroing them or performing a home operation into a switch.

 

The REF X, REF Y, REF Z etc... buttons may require editing using a screen editor.  We recommend the one written by Klaus Dietz.

 

 

 

 

The Ref buttons should be edited to perform the standard Mach3 Ref operations.  See the settings selected for the Ref buttons shown below when using Klaus' free Mach Screen Editor.  The standard Ref operations for Mach3 is to request the Plugin to perform the Home Operation (actually labeled purge in the plugin). 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

The Dynomotion Plugin passes these Home requests to KFlop to handle with a Home User Program.  In the Config|Config Plugins|Dynomotion set an appropriate KFlop User Home Program.  A flag variable is also passed to tell which axis is to be homed (Note that the flags is defined to be passed to the KFlop User Program via persist.UserData[5]).   In the case with encoders, both the Encoder Position and the Commanded Destination should be zeroed.   Prior to Zeroing if any homing motion (to a switch for example - See: SimpleHome3Axis.c in the C Programs directory) may also be added into the program.

 

Note: if Homing Inputs are enabled in Mach3 | Config | Ports and Pins | Input Signals | X Home, Y Home, Z Home, A Home, B Home, C Home then Mach 3 will NOT call the Plugin to do Homing.  Please make sure these Inputs are NOT enabled.

 

 

 

 

Example File: <Install Dir>\C Programs\HomeEncoderMach3.c

#include "KMotionDef.h"

//Plugin calls for Mach3 Home (actually Purge) Commands
//Called from Mach3 "REF" command
//in this case just Zero the measured position (encoder)
//and set the commanded destination to zero

#define X 0
#define Y 1
#define Z 2

main()
{
    int flags = persist.UserData[5]; // Mach3 flags bit0=X, bit1=Y, Bit2=Z, etc...

    printf("Mach3 Home Call, flags = %d\n",flags);

    if (flags & 1)
    {
        DisableAxis(X);
        Zero(X);
        EnableAxisDest(X,0.0);
    }
    if (flags & 2)
    {
        DisableAxis(Y);
        Zero(Y);
        EnableAxisDest(Y,0.0);
    }
    if (flags & 4)
    {
        DisableAxis(Z);
        Zero(Z);
        EnableAxisDest(Z,0.0);
    }
}