ISO15765-2 CANBus TP

/* Required shim/callback functions */
static uint8_t send_frame(canbus_md md, uint32_t id, uint8_t dlc, uint8_t* data);
static void usdata_indication(n_indn_t* info);
static void on_error(n_rslt err_type);
static uint32_t getms();

/* ISOTP handler */
static iso15765_t handler =
{
	.addr_md = N_ADM_FIXED,		// Selected address mode of the TP
	.can_md = CANBUS_EXTENDED,	// CANBus frame type
	.config.stmin = 0x05,		// Default min. frame transmission separation
	.config.bs = 0x0F,		// Maximun size of the block sequence
	.config.n_bs = 800,		// Time until reception of the next FlowControl N_PDU
 	.config.n_cr = 250,		// Time until reception of the next ConsecutiveFrame N_PDU
	.clbs.get_ms = getms,		// Time-source for the library in ms(required)
	.clbs.on_error = on_error,	// Callback which will be executed in any occured error.
	.clbs.send_frame = send_frame,	// This callback will be fired when a transmission of a canbus frame is ready.
	.clbs.indn = usdata_indication	// Indication Callback: Will be fired when a reception
					// is available or an error occured during the reception.
};

static uint8_t send_frame(canbus_md mode, uint32_t id, uint8_t dlc, uint8_t* data)
{
    // Here transmit the frame through CANBus
    return 0;
}

static void usdata_indication(n_indn_t* info)
{
    // Use the incoming message. This function should be fired by the library when a new complete message arrives.
}

static void on_error(n_rslt err_type)
{
    // Check the errors etc..
}

static uint32_t getms()
{
    // return time in ms; 
    // ex. return GetTickCount();
}

n_req_t frame =
{
    .n_ai.n_pr = 0x06,		// Network Address Priority
    .n_ai.n_sa = 0x01,		// Network Source Address
    .n_ai.n_ta = 0x02,		// Network Target Address
    .n_ai.n_ae = 0x00,		// Network Address Extension
    .n_ai.n_tt = N_TA_T_PHY,	// Network Target Address type
    .msg = {1,2,3,4,5,6,7,8,	// Message
    	    9,10,11,12,13,14,
	    15,16,17,18,19,20},
    .msg_sz = 20,		// Message size
};
...
iso15765_send(&handler, &frame);

#include <stdio.h>
#include <stdlib.h>
#include "iso15765_2.h"
#include <windows.h>
#include <sysinfoapi.h>

/******************************************************************************
* Declaration | Static Functions
******************************************************************************/

static uint8_t send_frame(canbus_md md, uint32_t id, uint8_t dlc, uint8_t* dt);
static void on_error(n_rslt err_type);
static uint32_t getms();

/******************************************************************************
* Enumerations, structures & Variables
******************************************************************************/

static iso15765_t handler =
{
        .addr_md = N_ADM_NORMAL,
        .can_md = CANBUS_STANDARD,
        .clbs.send_frame = send_frame,
        .clbs.on_error = on_error,
        .clbs.get_ms = getms,
        .config.stmin = 0x3,
        .config.bs = 0x0f,
        .config.n_bs = 100,
        .config.n_cr = 3
};

n_req_t frame =
{
        .n_ai.n_pr = 0x07,
        .n_ai.n_sa = 0x01,
        .n_ai.n_ta = 0x02,
        .n_ai.n_ae = 0x00,
        .n_ai.n_tt = N_TA_T_PHY,
        .msg = {1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23},
        .msg_sz = 23,
};

/******************************************************************************
* Definition  | Static Functions
******************************************************************************/

static uint32_t getms()
{
        return GetTickCount();
}

static uint8_t send_frame(canbus_md mode, uint32_t id, uint8_t dlc, uint8_t* dt)
{
        printf("%d  #1# - id:%x    dlc:%02x    ",GetTickCount(), id, dlc);
        for (int i = 0; i < 8; i++) printf("%02x ", dt[i]);
        printf("\n");
        canbus_frame_t frame = { .id = id, .dlc = 8, .mode = mode };
        memmove(frame.dt, dt, 8);
        iso15765_enqueue(&handler, &frame);
        return 0;
}

static void on_error(n_rslt err_type)
{
        printf("ERROR OCCURED!:%d", err_type);
}

/******************************************************************************
* Definition  | Public Functions
******************************************************************************/

int main()
{
        iso15765_init(&handler);

        iso15765_send(&handler, &frame);
        while(1)
        {
                iso15765_process(&handler);
                Sleep(5);
        }
        return 0;
}