_helpers.cs

using RSI.RapidCode; // RSI.RapidCode.dotNET;

public static class Helpers
{
    public static void CheckErrors(RapidCodeObject rsiObject)
    {
        var hasErrors = false;
        var errorStrBuilder = new System.Text.StringBuilder();
 
        while (rsiObject.ErrorLogCountGet() > 0)
        {
            // get error
            RsiError rsiError = rsiObject.ErrorLogGet();
 
            // get message
            var errorMsg = rsiError.isWarning ? $"WARNING: {rsiError.Message}" : $"ERROR: {rsiError.Message}";
            errorStrBuilder.AppendLine(errorMsg);
 
            // set flag
            hasErrors = !rsiError.isWarning;
        }
 
        if (hasErrors)
            throw new Exception(errorStrBuilder.ToString());
    }


    public static void NetworkStart(MotionController controller)
    {
        // check if network is started already
        if (controller.NetworkStateGet() != RSINetworkState.RSINetworkStateOPERATIONAL)
        {
            Console.WriteLine("Starting Network..");
 
            // if not started, initialize the network
            controller.NetworkStart();
        }
 
        // check if network is started again
        if (controller.NetworkStateGet() != RSINetworkState.RSINetworkStateOPERATIONAL)
        {
            // read network log messages
            int messagesToRead = controller.NetworkLogMessageCountGet();
 
            // print all the messages to help figure out the problem
            for (int i = 0; i < messagesToRead; i++)
                Console.WriteLine(controller.NetworkLogMessageGet(i));
 
            throw new SystemException("Expected OPERATIONAL state but the network did not get there.");
        }
        else
        {
            Console.WriteLine("Network Started");
        }
    }


    public static void NetworkShutdown(MotionController controller)
    {
        // check if the network is already shutdown
        if (controller.NetworkStateGet() == RSINetworkState.RSINetworkStateUNINITIALIZED ||
            controller.NetworkStateGet() == RSINetworkState.RSINetworkStateSHUTDOWN)
            return;
 
        // shutdown the network
        Console.WriteLine("Shutting down the network..");
        controller.NetworkShutdown();
 
        // check if the network is shutdown
        var networkState = controller.NetworkStateGet();
        if (networkState != RSINetworkState.RSINetworkStateUNINITIALIZED &&
            networkState != RSINetworkState.RSINetworkStateSHUTDOWN)
        {
            // some kind of error shutting down the network, read the network log messages
            int messagesToRead = controller.NetworkLogMessageCountGet();
 
            // print all the messages to help figure out the problem
            for (int i = 0; i < messagesToRead; i++)
                Console.WriteLine(controller.NetworkLogMessageGet(i));
 
            throw new SystemException("Expected SHUTDOWN state but the network did not get there.");
        }
        else
        {
            Console.WriteLine("Network Shutdown");
        }
    }


    public static void ControllerSetup(MotionController controller)
    {
        NetworkShutdown(controller);
 
        // reset the controller to ensure it is in a known state
        controller.Reset();
 
        NetworkStart(controller);
    }


    public static void PhantomAxisReset(Axis phantomAxis)
    {
        if (phantomAxis.MotorTypeGet() != RSIMotorType.RSIMotorTypePHANTOM)
        {
            throw new Exception(@$"Axis {phantomAxis.NumberGet()} is not configured as a phantom axis. 
                                   Please ensure the axis is set to phantom before calling PhantomAxisConfigure.");
        }
 
        // abort any motion
        AbortMotionObject(phantomAxis);
 
        // disable all limits (not used for phantom axes)
        phantomAxis.ErrorLimitActionSet(RSIAction.RSIActionNONE);
        phantomAxis.HardwareNegLimitActionSet(RSIAction.RSIActionNONE);
        phantomAxis.HardwarePosLimitActionSet(RSIAction.RSIActionNONE);
        phantomAxis.HomeActionSet(RSIAction.RSIActionNONE);
        phantomAxis.SoftwareNegLimitActionSet(RSIAction.RSIActionNONE);
        phantomAxis.SoftwarePosLimitActionSet(RSIAction.RSIActionNONE);
 
        // set position tolerances to max value for immediate MotionDone
        double POSITION_TOLERANCE_MAX = Double.MaxValue / 10.0;
        phantomAxis.PositionToleranceCoarseSet(POSITION_TOLERANCE_MAX);
        phantomAxis.PositionToleranceFineSet(POSITION_TOLERANCE_MAX);
 
        // set sample apps default motion parameters
        phantomAxis.UserUnitsSet(1);
        phantomAxis.DefaultVelocitySet(100);
        phantomAxis.DefaultAccelerationSet(1000);
        phantomAxis.DefaultDecelerationSet(1000);
        phantomAxis.DefaultJerkPercentSet(0);
        phantomAxis.PositionSet(0);
    }
 

    /// @internal @[AbortMotionObject]
    public static void AbortMotionObject(RapidCodeMotion motionObject)
    {
        motionObject.EStopAbort();
        motionObject.MotionDoneWait();
        motionObject.ClearFaults();
 
        // check for idle state
        if (motionObject.StateGet() != RSIState.RSIStateIDLE)
        {
            RSISource source = motionObject.SourceGet(); // get state source enum 
            string errorMsg = @$"Axis or MultiAxis {motionObject.NumberGet()} failed to enter IDLE state after aborting. 
                                 The source of the axis error is: {motionObject.SourceNameGet(source)}";
            throw new Exception(errorMsg);
        }
    }

}