App.c

EtherNet/IP™ Adapter Example Application.

Author

KUNBUS GmbH

Date

2021-06-09

Copyright

Copyright (c) 2021, KUNBUS GmbH

All rights reserved.
Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:

1. Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
2. Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution.
3. Neither the name of the copyright holder nor the names of its contributors may be used to endorse or promote products derived from this software without specific prior written permission.

THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <stdbool.h>
#include <string.h>
#include <stdarg.h>
 
#include <api/EI_API.h>
#include <api/EI_API_def.h>
 
#include "AppPerm.h"
#include <drivers/pinmux.h>
#include <drivers/pruicss.h>
#include <drivers/sciclient/include/sciclient_pm.h>
#include <appPhyReset.h>
 
#include <osal.h>
#include <osal_error.h>
#include <hwal.h>
#include <pru.h>
#include <pru_EthernetIP.h>
#include <Board.h>
 
#include <kbTrace.h>
 
 
#include <App.h>
#include <AppClass71.h>
 
#if defined(SOC_AM64X) || defined(SOC_AM243X)
#include "ti_drivers_config.h"
#include "ti_drivers_open_close.h"
#include "ti_board_config.h"
#include "ti_board_open_close.h"
#endif
 
#if defined(SOC_AM64X) || defined(SOC_AM243X)
//Board_IDInfo_v2 boardInfo;
extern PRUICSS_Handle prusshandle;
//int _vectors = 0;
#else
Board_IDInfo boardInfo;
#endif
 
// Global variables and pointers used in this example.
// has to stay, used in lib_eip_lwip_ip :-(
uint8_t EI_APP_aMacAddr_g[] = {0xc8, 0x3e, 0xa7, 0x00, 0x00, 0x59};
 
 
// Static variables and pointers used in this example.
static void *EI_APP_pvTaskMainHandle_s;
static uint8_t EI_APP_aTaskStackMainStack_s[EI_APP_STACK_MAIN_TASK_STACK_SIZE];
 
static EI_API_ADP_T*      pAdp_s = NULL;
static EI_API_CIP_NODE_T* pCip_s = NULL;
 
// Function prototypes.
static uint8_t* EI_APP_getMacAddr (void);
static bool     EI_APP_cipSetup(EI_API_CIP_NODE_T* pCipNode_p);
static bool     EI_APP_cipCreateCallback(EI_API_CIP_NODE_T* pCipNode_p);
 
uint32_t EI_APP_globalError_g = 0;
uint8_t  EI_APP_pruLogicalInstance_g = EI_API_ADP_PRUICCSS_INSTANCE_TWO;
 
 
static int EI_APP_cleanup()
{
    int exit_code = 0;
 
    // Try to delete the CIP node.
    if (EI_API_CIP_NODE_delete(pCip_s))
    {
        // Fail.
        exit_code = 1;
    }
 
    // Try to delete the ADP.
    if (EI_API_ADP_delete(pAdp_s))
    {
        // Fail.
        exit_code = 1;
    }
 
    // Try to deinitialize the IDK board (unexport the GPIO pins).
    if (IDK_deInit(pAdp_s, eTMDX654IDKEVM))
    {
        // Fail
        exit_code = 1;
    }
 
    return exit_code;
}
 
 
void EI_APP_adpInit(void)
{
    uint32_t errCode = 0;
    uint16_t vendorId = 806;
    uint16_t deviceType = 0x000c;
    uint16_t productCode = 0x6401;
    uint32_t serialNumber = 0x00000065;
 
    EI_API_ADP_SRevision_t revision;
 
    const char productName[] = "EtherNet/IP(tm) Adapter";
 
    errCode = EI_API_ADP_setVendorId(pAdp_s, vendorId);
    errCode = EI_API_ADP_setDeviceType(pAdp_s, deviceType);
    errCode = EI_API_ADP_setProductCode(pAdp_s, productCode);
 
    revision.major = 0x01;
    revision.minor = 0x03;
    errCode = EI_API_ADP_setRevision(pAdp_s, revision);
 
    errCode = EI_API_ADP_setSerialNumber(pAdp_s, serialNumber);
    errCode = EI_API_ADP_setProductName(pAdp_s, productName);
 
    // apply permanent saved data.
    EI_APP_PERM_read(true);
}
 
void EI_APP_cipGenerateContent(EI_API_CIP_NODE_T* pCipNode_p, uint16_t classId_p, uint16_t instanceId_p)
{
    EI_API_CIP_SService_t service;
    uint16_t i = 0;
 
    EI_API_CIP_createClass(pCip_s, classId_p);
 
    service.getAttrAllResponseCnt = 0;
    service.callback = NULL;
    service.code = EI_API_CIP_eSC_GETATTRSINGLE;
    EI_API_CIP_addClassService(pCip_s, classId_p, &service);
    service.code = EI_API_CIP_eSC_SETATTRSINGLE;
    EI_API_CIP_addClassService(pCip_s, classId_p, &service);
 
    EI_API_CIP_createInstance(pCip_s, classId_p, instanceId_p);
 
    service.code = EI_API_CIP_eSC_GETATTRSINGLE;
    EI_API_CIP_addInstanceService(pCip_s, classId_p, instanceId_p, &service);
    service.code = EI_API_CIP_eSC_SETATTRSINGLE;
    EI_API_CIP_addInstanceService(pCip_s, classId_p, instanceId_p, &service);
 
    uint16_t attribID = 0x300;
 
    // 64 USINT (uint8_t).
    for (i = 0; i < 64; i++)
    {
        EI_API_CIP_SAttr_t attr;
        memset(&attr, 0, sizeof(attr));
        attr.id = attribID;
        attr.edt = EI_API_CIP_eEDT_USINT;
        attr.accessRule = EI_API_CIP_eAR_GET_AND_SET;
        attr.pvValue = &i;
 
        EI_API_CIP_addInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
        EI_API_CIP_setInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
 
        attribID++;
    }
 
    // 32 UINT (uint16_t).
    for (i = 0; i < 32; i++)
    {
        EI_API_CIP_SAttr_t attr;
        memset(&attr, 0, sizeof(attr));
        attr.id = attribID;
        attr.edt = EI_API_CIP_eEDT_UINT;
        attr.accessRule = EI_API_CIP_eAR_GET_AND_SET;
        attr.pvValue = &i;
 
        EI_API_CIP_addInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
        EI_API_CIP_setInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
 
        attribID++;
    }
 
    // 16 UDINT (uint32_t).
    for (i = 0; i < 16; i++)
    {
        EI_API_CIP_SAttr_t attr;
        memset(&attr, 0, sizeof(attr));
        attr.id = attribID;
        attr.edt = EI_API_CIP_eEDT_UDINT;
        attr.accessRule = EI_API_CIP_eAR_GET_AND_SET;
        attr.pvValue = &i;
 
        EI_API_CIP_addInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
        EI_API_CIP_setInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
 
        attribID++;
    }
 
    // 8 ULINT (uint64_t).
    for (i = 0; i < 8; i++)
    {
        EI_API_CIP_SAttr_t attr;
        memset(&attr, 0, sizeof(attr));
        attr.id = attribID;
        attr.edt = EI_API_CIP_eEDT_ULINT;
        attr.accessRule = EI_API_CIP_eAR_GET_AND_SET;
        attr.pvValue = &i;
 
        EI_API_CIP_addInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
        EI_API_CIP_setInstanceAttr(pCip_s, classId_p, instanceId_p, &attr);
 
        attribID++;
    }
}
 
static bool EI_APP_cipSetup(EI_API_CIP_NODE_T* pCipNode_p)
{
    uint32_t errCode = 0;
    uint16_t i = 0;
 
    uint16_t classId = 0x70;
    uint16_t instanceId = 0x01;
 
 
    // Create new class 0x70 with read and write service and several attributes.
    EI_APP_cipGenerateContent(pCipNode_p, classId, instanceId);
 
    errCode = EI_API_CIP_createAssembly(pCipNode_p, 0xfe, EI_API_CIP_eAR_GET); // Input-only.
    errCode = EI_API_CIP_createAssembly(pCipNode_p, 0xff, EI_API_CIP_eAR_GET); // Listen-only.
 
    errCode = EI_API_CIP_createAssembly(pCipNode_p, 0x64, EI_API_CIP_eAR_GET_AND_SET);
    errCode = EI_API_CIP_createAssembly(pCipNode_p, 0x65, EI_API_CIP_eAR_GET_AND_SET);
 
    for (i = 0x300; i < 0x305; i++)
    {
        errCode = EI_API_CIP_addAssemblyMember(pCipNode_p, 0x64, classId, instanceId, i);
        if (errCode != EI_API_CIP_eERR_OK)
        {
            OSAL_printf("Failed to add Class ID %#x, Instance ID %#x, Attribute ID %#x to Assembly Instance 0x64:  Error code: 0x%08x\n", classId, instanceId, (uint16_t)i, errCode);
        }
 
        errCode = EI_API_CIP_addAssemblyMember(pCipNode_p, 0x65, classId, instanceId, (uint16_t)(8 + i));
        if (errCode != EI_API_CIP_eERR_OK) {
            OSAL_printf("Failed to add Class ID %#x, Instance ID %#x, Attribute ID %#x to Assembly Instance 0x65:  Error code: 0x%08x\n", classId, instanceId, (uint16_t)(8 + i), errCode);
        }
 
    }
 
    return true;
}
 
 
static bool EI_APP_cipCreateCallback(EI_API_CIP_NODE_T* pCipNode_p)
{
    uint8_t errorCnt = 0;   // Variable to check sum up return errors.
 
    // Your callback function which stores your data when triggered.
    EI_API_CIP_CBService ptr_my_config_cb = EI_APP_PERM_configCb;
 
    // Register callbacks for Set_Attribute_Single service.
    EI_API_CIP_SService_t srvc = { EI_API_CIP_eSC_SETATTRSINGLE, 0, NULL, ptr_my_config_cb };
    EI_API_CIP_setInstanceServiceFunc(pCipNode_p, 0x00F5, 0x0001, &srvc);
    EI_API_CIP_setInstanceServiceFunc(pCipNode_p, 0x00F6, 0x0001, &srvc);
    EI_API_CIP_setInstanceServiceFunc(pCipNode_p, 0x00F6, 0x0002, &srvc);
    EI_API_CIP_setInstanceServiceFunc(pCipNode_p, 0x0048, 0x0001, &srvc);
 
    // Add callback for Reset service of class ID 0x01.
    EI_API_CIP_SService_t srvcReset = { EI_API_CIP_eSC_RESET, 0, NULL, EI_APP_PERM_reset };
    if (EI_API_CIP_setInstanceServiceFunc(pCipNode_p, 0x01, 0x01, &srvcReset) != EI_API_CIP_eERR_OK) errorCnt++;
 
    return true;
}
 
bool EI_APP_init(void)
{
    bool result = 1;
    EI_API_ADP_SParam_t macAddr;
 
 
    // Initialize adapter for 1 (one) interface.
    pAdp_s = EI_API_ADP_new(1);
 
    // Init module for permanent data.
    EI_APP_PERM_init(pAdp_s);
 
    // Setup error handler for the EtherNet/IP stack.
    EI_API_ADP_setErrorHandlerFunc(EI_APP_stackErrorHandlerCb);
 
    EI_APP_stackInit(EI_APP_pruLogicalInstance_g);
 
    // Create a CIP node.
    pCip_s = EI_API_CIP_NODE_new();
 
    // Create callbacks for changed values.
    EI_APP_cipCreateCallback(pCip_s);
 
    // Create vendor specific classes.
    EI_APP_cipSetup(pCip_s);
 
    IDK_init(pAdp_s, eTMDX654IDKEVM);
 
    EI_APP_CLASS71_init(pCip_s);
 
    // Initialize data for the adapter.
    EI_APP_adpInit();
 
    // Finally apply.
    EI_API_ADP_init(pAdp_s);
 
    EI_API_ADP_getMacAddr(pAdp_s, &macAddr);
 
    OSAL_printf("EI_API_ADP_getMacAddr:  %02x:%02x:%02x:%02x:%02x:%02x\r\n",
        macAddr.data[0],
        macAddr.data[1],
        macAddr.data[2],
        macAddr.data[3],
        macAddr.data[4],
        macAddr.data[5]);
 
    return result;
}
 
void EI_APP_run(void)
{
    EI_API_ADP_run();
    //IDK_run(pCip_s);
    //EI_APP_CLASS71_run();
}
 
void EI_APP_mainTask(
    void* pvTaskArg_p)
{
    Board_init();
    Drivers_open();
    Board_driversOpen();
    //EIP_socInit();
    //GPIO_init();
 
    int16_t resetServiceFlag;
    if (false == EI_APP_init())
    {
        OSAL_printf("Fatal error: application initialization failed\n");
        return;
    }
 
    for (;;)
    {
        EI_APP_run();
        resetServiceFlag = EI_APP_PERM_getResetRequired();
        if (resetServiceFlag  != -1)
        {
            break;
        }
 
        OSAL_SCHED_yield();
    }
 
    EI_APP_cleanup();
 
    PRU_EIP_stop();
 
    Board_deinit();
 
    System_deinit();
 
    Sciclient_pmDeviceReset(0xFFFFFFFFU);
}
 
int main(
    int argc,
    char* argv[])
{
    uint32_t err;
 
    System_init ();
 
    Board_init ();
 
    err = HWAL_init ();
    if (err != OSAL_NO_ERROR)
    {
        goto laError;
    }
 
    OSAL_registerErrorHandler (EI_APP_osErrorHandlerCb);
 
    err = OSAL_init ();
    if (err != OSAL_NO_ERROR)
    {
        goto laError;
    }
 
    EI_APP_pvTaskMainHandle_s = OSAL_SCHED_startTask (EI_APP_mainTask,
                                                      (void*)&EI_APP_pruLogicalInstance_g,
                                                      OSAL_TASK_ePRIO_4,
                                                      EI_APP_aTaskStackMainStack_s,
                                                      EI_APP_STACK_MAIN_TASK_STACK_SIZE,
                                                      OSAL_OS_START_TASK_FLG_NONE,
                                                      "main_task");
    if (EI_APP_pvTaskMainHandle_s == NULL)
    {
        goto laError;
    }
 
    OSAL_startOs ();
 
    return (0);
 
//-------------------------------------------------------------------------------------------------
laError:
 
    return (-1);
}
 
 
void EI_APP_stackErrorHandlerCb(
    uint32_t i32uErrorCode_p,
    uint8_t  bFatal_p,
    uint8_t  i8uNumOfPara_p,
    va_list  argptr_p)
{
    OSAL_printf("###### Stack Error: 0x%08x, %s ######\n", i32uErrorCode_p, bFatal_p == 0 ? "non fatal" : "fatal");
 
    if (bFatal_p)
    {
        // TODO: handle the app_cleanup return codes.
        EI_APP_cleanup();
        // TODO: Return an appropriate exit code in this case.
        exit(255);
    }
 
}
 
void EI_APP_osErrorHandlerCb (
    uint32_t errorCode_p,           
    bool fatal_p,                   
    uint8_t paraCnt_p,              
    va_list argptr_p)               
 
{
    int32_t argInd;
    uint32_t arg;
 
    EI_APP_globalError_g = errorCode_p;
 
    OSAL_printf ("\nError: 0x%8.8x, Fatal: %s", errorCode_p, fatal_p ? "yes" : "no");
 
//    for (argInd = 0; argInd < paraCnt_p; argInd++)
//    {   // assume all Parameters are 32bit unsigned integer
//        arg = va_arg (argptr_p, uint32_t);
//        printf (", P%d: 0x%8.8x", argInd, arg);
//    }
 
    if (fatal_p == true)
    {
        //while (DBG_keepLoop_g)
        //{
        //    DBG_iDebug_g++;
        //}
 
        exit (1);
    }
}
 
 
//*************************************************************************************************
void EI_APP_stackInit (uint8_t pruInstance_p)
{
    uint32_t err;
    EIP_SLoadParameter tParam;
 
    err = APP_initPhyResetGpio ();
    if (err != OSAL_NO_ERROR)
    {
        goto laError;
    }
 
    memset (&tParam, 0, sizeof (EIP_SLoadParameter));
    memmove (tParam.ai8uMacAddr, EI_APP_getMacAddr(), 6);
 
    err = EI_API_ADP_loadMac (&tParam, pruInstance_p);
    if (err)
    {
        goto laError;
    }
 
    OSAL_printf("+EI_API_ADP_startFirmware\r\n");
    EI_API_ADP_startFirmware();
    OSAL_printf("-EI_API_ADP_startFirmware\r\n");
 
    return;
 
//-------------------------------------------------------------------------------------------------
laError:
 
    printf ("\nStack Init Error: 0x%8.8x", err);
    return;
}
 
//*************************************************************************************************
//| Function:
//|
//-------------------------------------------------------------------------------------------------
static uint8_t* EI_APP_getMacAddr (void)
{
#ifndef _DEBUG_USE_KUNBUS_MAC_ADDRESS
    static uint8_t mac_addr[6];
    const uint32_t mac_address_upper_16_bits = *IDK_CTRLMMR0_MAC_ID1;
    const uint32_t mac_address_lower_32_bits = *IDK_CTRLMMR0_MAC_ID0;
    mac_addr[0] = (uint8_t) (mac_address_upper_16_bits >> 8);
    mac_addr[1] = (uint8_t) (mac_address_upper_16_bits);
    mac_addr[2] = (uint8_t) (mac_address_lower_32_bits >> 24);
    mac_addr[3] = (uint8_t) (mac_address_lower_32_bits >> 16);
    mac_addr[4] = (uint8_t) (mac_address_lower_32_bits >> 8);
    mac_addr[5] = (uint8_t) (mac_address_lower_32_bits);
    // EI_APP_aMacAddr_g is directly used in lwip
    memcpy(EI_APP_aMacAddr_g, mac_addr, 6);
    return mac_addr;
#else
    return EI_APP_aMacAddr_g;
#endif
}
 
 
//*************************************************************************************************