LIN_UnconditionalFrame/main.cpp

Unconditional Frame example

Schedule table contains three unconditionnal frames 0x30, 0x31 and 0x32.

#include <vector>
#include <iostream>
#include <thread>
#include <array>
 
#define AGHAF_DYNAMIC_LIBRARY_INIT
#include <aghaf.h>
 
#include <iostream>
#include <iomanip>
 
void onLinMasterTx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    if (data != nullptr) {
        std::cout << "0x";
        for (uint8_t i = 0; i < datalen; ++i) {
            std::cout << std::hex << std::setw(2) << std::setfill('0')
                      << static_cast<int>(data[i]);
        }
        std::cout << std::endl;
    } else {
        std::cout << "no data" << std::endl;
    }
}
 
void onLinMasterRx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    std::cout << "0x";
    for (uint8_t i = 0; i < datalen; ++i) {
        std::cout << std::hex << std::setw(2) << std::setfill('0')
                  << static_cast<int>(data[i]);
    }
    std::cout << std::endl;
}
 
void onLinMasterError(
        uint64_t timestamp,
        AGHAF_LIN_Error error,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "error: " << static_cast<int>(error) << std::endl;
}
 
void onLinSlave1Tx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    if (data != nullptr) {
        std::cout << "0x";
        for (uint8_t i = 0; i < datalen; ++i) {
            std::cout << std::hex << std::setw(2) << std::setfill('0')
                      << static_cast<int>(data[i]);
        }
        std::cout << std::endl;
    } else {
        std::cout << "no data" << std::endl;
    }
}
 
void onLinSlave1Rx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    std::cout << "0x";
    for (uint8_t i = 0; i < datalen; ++i) {
        std::cout << std::hex << std::setw(2) << std::setfill('0')
                  << static_cast<int>(data[i]);
    }
    std::cout << std::endl;
}
 
void onLinSlave1Error(
        uint64_t timestamp,
        AGHAF_LIN_Error error,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "error: " << static_cast<int>(error) << std::endl;
}
 
void onLinSlave2Tx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    if (data != nullptr) {
        std::cout << "0x";
        for (uint8_t i = 0; i < datalen; ++i) {
            std::cout << std::hex << std::setw(2) << std::setfill('0')
                      << static_cast<int>(data[i]);
        }
        std::cout << std::endl;
    } else {
        std::cout << "no data" << std::endl;
    }
}
 
void onLinSlave2Rx(
        uint64_t timestamp,
        uint8_t fid,
        uint8_t datalen,
        uint8_t const* data,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "datalen: " << static_cast<int>(datalen) << std::endl;
    std::cout << "fid: " << static_cast<int>(fid) << std::endl;
    std::cout << "0x";
    for (uint8_t i = 0; i < datalen; ++i) {
        std::cout << std::hex << std::setw(2) << std::setfill('0')
                  << static_cast<int>(data[i]);
    }
    std::cout << std::endl;
}
 
void onLinSlave2Error(
        uint64_t timestamp,
        AGHAF_LIN_Error error,
        void *userContext)
{
    (void) timestamp;
    (void) userContext;
    std::cout << __FUNCTION__ << std::endl;
    std::cout << "error: " << static_cast<int>(error) << std::endl;
}
 
int main()
{
#ifdef _WIN32
    AGHAF_loadLibrary(AGHAF_DEFAULT_FILENAME);
#endif
 
    uint32_t count = AGHAF_getDeviceCount();
    if (count > 0) {
        AGHAF_DeviceInfo *devicesInfo = nullptr;
        uint32_t deviceInfoNumber = 0;
        AGHAF_getDeviceList(&devicesInfo, &deviceInfoNumber);
 
        if (deviceInfoNumber > 2) {
            AGHAF_Device deviceMaster = AGHAF_getDeviceBySN(
                        devicesInfo[0].productNo,
                    devicesInfo[0].serialNo);
            AGHAF_Device deviceSlave1 = AGHAF_getDeviceBySN(
                        devicesInfo[1].productNo,
                    devicesInfo[1].serialNo);
 
            AGHAF_Device deviceSlave2 = AGHAF_getDeviceBySN(
                        devicesInfo[2].productNo,
                    devicesInfo[2].serialNo);
 
            AGHAF_openDevice(deviceMaster);
            AGHAF_openDevice(deviceSlave1);
            AGHAF_openDevice(deviceSlave2);
 
            uint8_t linCount1 = AGHAF_LIN_getCount(deviceMaster);
            uint8_t linCount2 = AGHAF_LIN_getCount(deviceSlave1);
            uint8_t linCount3 = AGHAF_LIN_getCount(deviceSlave2);
 
            if (linCount1 > 0 && linCount2 > 0 && linCount3 > 0) {
                AGHAF_LIN linMaster = AGHAF_LIN_get(deviceMaster, 0);
                AGHAF_LIN_setOnMessageRxCallback(linMaster, &onLinMasterRx, nullptr);
                AGHAF_LIN_setOnMessageTxCallback(linMaster, &onLinMasterTx, nullptr);
                AGHAF_LIN_setOnErrorCallback(linMaster, &onLinMasterError, nullptr);
                AGHAF_LIN_setParam(linMaster,
                                   AGHAF_LIN_PARAM_BAUDRATE,
                                   19200);
                AGHAF_LIN_setParam(linMaster,
                                   AGHAF_LIN_PARAM_MODE,
                                   AGHAF_LIN_MODE_MASTER);
 
                AGHAF_LIN linSlave1 = AGHAF_LIN_get(deviceSlave1, 0);
                AGHAF_LIN_setOnMessageRxCallback(linSlave1, &onLinSlave1Rx, nullptr);
                AGHAF_LIN_setOnMessageTxCallback(linSlave1, &onLinSlave1Tx, nullptr);
                AGHAF_LIN_setOnErrorCallback(linSlave1, &onLinSlave1Error, nullptr);
                AGHAF_LIN_setParam(linSlave1,
                                   AGHAF_LIN_PARAM_BAUDRATE,
                                   19200);
                AGHAF_LIN_setParam(linSlave1,
                                   AGHAF_LIN_PARAM_MODE,
                                   AGHAF_LIN_MODE_SLAVE);
 
                AGHAF_LIN linSlave2 = AGHAF_LIN_get(deviceSlave2, 0);
                AGHAF_LIN_setOnMessageRxCallback(linSlave2, &onLinSlave2Rx, nullptr);
                AGHAF_LIN_setOnMessageTxCallback(linSlave2, &onLinSlave2Tx, nullptr);
                AGHAF_LIN_setOnErrorCallback(linSlave2, &onLinSlave2Error, nullptr);
                AGHAF_LIN_setParam(linSlave2,
                                   AGHAF_LIN_PARAM_BAUDRATE,
                                   19200);
                AGHAF_LIN_setParam(linSlave2,
                                   AGHAF_LIN_PARAM_MODE,
                                   AGHAF_LIN_MODE_SLAVE);
 
                AGHAF_LIN_SCHEDULE_addUnconditional(linMaster, 0, 0x30, 2);
                AGHAF_LIN_SCHEDULE_addUnconditional(linMaster, 0, 0x31, 2);
                AGHAF_LIN_SCHEDULE_addUnconditional(linMaster, 0, 0x32, 2);
                AGHAF_LIN_SCHEDULE_configure(linMaster, 0, AGHAF_LIN_SCHEDULE_KIND_LOOP);
 
                std::array<uint8_t, 1> frame30 = { 0x0A };
                AGHAF_LIN_configureFrame(
                            linMaster,
                            0x30,
                            AGHAF_LIN_FRAME_KIND_SUBSCRIBE,
                            0,
                            static_cast<uint8_t>(frame30.size()),
                            nullptr);
                AGHAF_LIN_configureFrame(
                            linSlave1,
                            0x30,
                            AGHAF_LIN_FRAME_KIND_PUBLISH,
                            0,
                            static_cast<uint8_t>(frame30.size()),
                            frame30.data());
 
                std::array<uint8_t, 1> frame31 = { 0x0B };
                AGHAF_LIN_configureFrame(
                            linMaster,
                            0x31,
                            AGHAF_LIN_FRAME_KIND_PUBLISH,
                            0,
                            static_cast<uint8_t>(frame31.size()),
                            frame31.data());
 
                AGHAF_LIN_configureFrame(
                            linSlave1,
                            0x31,
                            AGHAF_LIN_FRAME_KIND_SUBSCRIBE,
                            0,
                            static_cast<uint8_t>(frame31.size()),
                            nullptr);
 
                AGHAF_LIN_configureFrame(
                            linSlave2,
                            0x31,
                            AGHAF_LIN_FRAME_KIND_SUBSCRIBE,
                            0,
                            static_cast<uint8_t>(frame31.size()),
                            nullptr);
 
                std::array<uint8_t, 1> frame32 = { 0x0C };
                AGHAF_LIN_configureFrame(
                            linMaster,
                            0x32,
                            AGHAF_LIN_FRAME_KIND_IGNORE,
                            0,
                            static_cast<uint8_t>(frame32.size()),
                            nullptr);
 
                AGHAF_LIN_configureFrame(
                            linSlave1,
                            0x32,
                            AGHAF_LIN_FRAME_KIND_SUBSCRIBE,
                            0,
                            static_cast<uint8_t>(frame32.size()),
                            nullptr);
 
                AGHAF_LIN_configureFrame(
                            linSlave2,
                            0x32,
                            AGHAF_LIN_FRAME_KIND_PUBLISH,
                            0,
                            static_cast<uint8_t>(frame32.size()),
                            frame32.data());
 
                AGHAF_LIN_activate(linMaster);
                AGHAF_LIN_activate(linSlave1);
                AGHAF_LIN_activate(linSlave2);
                AGHAF_LIN_SCHEDULE_start(linMaster, 0);
                std::this_thread::sleep_for(std::chrono::milliseconds(100));
                AGHAF_LIN_SCHEDULE_stop(linMaster);
                AGHAF_LIN_deactivate(linSlave2);
                AGHAF_LIN_deactivate(linSlave1);
                AGHAF_LIN_deactivate(linMaster);
            }
 
            AGHAF_closeDevice(deviceMaster);
            AGHAF_closeDevice(deviceSlave1);
            AGHAF_closeDevice(deviceSlave2);
        }
 
        AGHAF_freeDeviceList(devicesInfo);
    }
 
#ifdef _WIN32
    AGHAF_unloadLibrary();
#endif
    return 0;
}