CAN_1Ax_DS402_ProfilePositionMode-ppm-Test.mc

 
#include "..\..\..\SDK\SDK_ApossC.mc"
 
 
 
// Bus settings
#define SLAVE_CAN_BUSID             1
 
void errorHandler();
void faultMonitoring();
 
long main(void)
{
    long handle;
    long actState=0;
 
    //Reset CAN Bus 1
    handle = DefCanOut(0, 2);
    CanOut(handle, 0, 0x8100);
    //Reset CAN Bus 2
    handle = DefCanOut(100000, 2);
    CanOut(handle, 0, 0x8100);
 
    //Wait until the node has been resetted
    Delay(2000);
    ErrorClear();
 
    //set errorHandler for master
    InterruptSetup(ERROR, errorHandler);
    //Monitior the Fault bit in the status word of the slave, all 25ms
    InterruptSetup(PERIOD, faultMonitoring, 25);
 
    //----------------------------------------------------------------
    // Application Setup
    //----------------------------------------------------------------
 
    //Set the mode of operation to PPM
    sdkDS402_SetOpartionMode(SLAVE_CAN_BUSID, DS402_OP_PPM);
 
    actState = sdkDS402_GetActDriveState(SLAVE_CAN_BUSID);
    if(actState == DS402_DRIVE_STATE_SWITCH_ON_DISABLED)
    {
        sdkDS402_WaitTransitionToState(SLAVE_CAN_BUSID, DS402_DRIVE_STATE_READY_TO_SWITCH_ON, -1);
    }
 
    //Set acceleration, deceleration and velocity
    sdkDS402_SetProfileMovementParameter(SLAVE_CAN_BUSID, 1000, 1000, 500);
 
    //Set the deccelation for quick stop
    sdkDS402_SetQuickStopDeceleration(SLAVE_CAN_BUSID, 5000);
 
    //----------------------------------------------------------------
    // End of Application Setup
    //----------------------------------------------------------------
 
 
    //Transition to drive state 'Operation enabled'
    sdkDS402_TransitionToState(SLAVE_CAN_BUSID, DS402_DRIVE_STATE_OPERATION_ENABLED);
 
    Delay(2);
 
    sdkDS402_Print_StatusWord(SLAVE_CAN_BUSID);
    while(1)
    {
        //Start absolute positioning to pos 100000 qc
        sdkDS402_PPM_PosAbsStart(SLAVE_CAN_BUSID, 100000, DS402_PPM_IMMEDIATELY);
        //Wait until the target position has been reached
        sdkDS402_PPM_WaitTargetReached(SLAVE_CAN_BUSID, -1);
 
        //Start relative positioning of -100000 qc
        sdkDS402_PPM_PosRelStart(SLAVE_CAN_BUSID, -100000, DS402_PPM_IMMEDIATELY);
        //Wait until the target position has been reached
        sdkDS402_PPM_WaitTargetReached(SLAVE_CAN_BUSID, -1);
    }
 
    return(1);
}
 
void faultMonitoring()
{
    long statusWord = sdkDS402_ReadStatusWord(SLAVE_CAN_BUSID);
    if(statusWord.i[DS402_SW_BIT_FAULT])
    {
        errorHandler();
    }
}
 
void errorHandler()
{
 
    long axeNbr     = ErrorAxis();
    long errNbr     = ErrorNo();
    long errInfoNbr = ErrorInfo();
    long statusWord, sdoAbortCode;
 
    //Stop all nodes
    sdkDS402_QuickStop(SLAVE_CAN_BUSID);
 
    print("-----------------------------------------------------------");
    printf("Error %d: ",errNbr);
    sdkErrorPrint_ApossIdeErrorDescription(errNbr);
    print();
    print("...Info: ",errInfoNbr, " AxisNo: ", axeNbr);
    print("- - - - - - - - - - - - - - - - - - - - - - - - - - - - - -");
    print();
 
    switch(errNbr)
    {
        case F_CANIO:
            sdoAbortCode = SYS_PROCESS(SYS_CANOM_SDOABORT);
            printf("SDO Abort Code 0x%lX: ", sdoAbortCode );
            sdkErrorPrint_SdoErrorDescription(SYS_PROCESS(SYS_CANOM_SDOABORT));
            print();
            print("Check Can baudrate & Can bus id");
    }
 
    if(axeNbr == 0xFF && errNbr != F_CANIO)
    {
        //The error is not releated to a certain axis
        statusWord = sdkDS402_ReadStatusWord(SLAVE_CAN_BUSID);
        if(statusWord.i[DS402_SW_BIT_FAULT])
        {
            print();
 
            printf("Bus Id %d, Slave device is in fault state\n", SLAVE_CAN_BUSID);
            if(statusWord.i[DS402_SW_PPM_BIT_FOLLWING_ERROR])
            {
                print("...Following Error");
            }
 
 
            //Reset the fault
            sdkDS402_ResetFault(SLAVE_CAN_BUSID);
        }
    }
 
    ErrorClear();
    print();
    print(" There is no error handlig → Exit()");
    print("-----------------------------------------------------------");
    Exit(0);
}