C语言实现J1939长帧组包接口以及模拟DM1数据并生成CANalyst数据文件

C语言实现J1939长帧组包接口以及模拟DM1数据并生成CANalyst数据文件

利用Dev-Cpp v5.11，通过C语言实现，经过Code::Blocks编译后，会生成exe文件，可以直接用exe文件执行，完成后会在程序目录生成CANalyst工具适用的文件，具体代码如下：

#include 
#include 
#include 

/****************************************************************
    DEFINE THE DATATYPE
****************************************************************/
typedef unsigned char  BOOLEAN;
typedef unsigned char  INT8U;                   /* Unsigned  8 bit quantity                           */
typedef signed   char  INT8S;                   /* Signed    8 bit quantity                           */
typedef unsigned short INT16U;                  /* Signed   16 bit quantity                           */
typedef signed   short INT16S;                  /* Unsigned 32 bit quantity                           */
typedef unsigned int   INT32U;                  /* Unsigned 32 bit quantity                           */
typedef unsigned long  long INT64U;             /* Unsigned 64 bit quantity                           */
typedef signed   int   INT32S;                  /* Signed   32 bit quantity                           */
typedef float          FP32;                    /* Single precision floating point                    */
typedef double         FP64;                    /* Double precision floating point                    */
typedef  unsigned long ip_addr;

#ifndef  false
#define  false                  0
#endif

#ifndef  true
#define  true                   1
#endif

#ifndef  TRUE
#define  TRUE                   1
#endif

#ifndef   FALSE
#define   FALSE                 0
#endif

#define MEMCPY_EX(DET_PTR, DET_LEN, SRC_PTR, SRC_LEN)   \
do {                                                    \
    assert((DET_LEN) >= (SRC_LEN));     \
    memcpy(DET_PTR, SRC_PTR, SRC_LEN);                  \
} while(0)

INT8U HexToChar(INT8U sbyte)
{
    sbyte &= 0x0F;
    if (sbyte < 0x0A) return (sbyte + '0');
    else return (sbyte - 0x0A + 'A');
}

BOOLEAN printf_hex(INT8U *ptr, INT16U len)
{
    INT16U i = 0;
    INT8U  ch;
    INT8U s_debugmem[4096] = {0};

    if (ptr == 0 || len == 0) {
        return false;
    }

    memset(s_debugmem, 0, sizeof(s_debugmem));
    for (i = 0; len > 0; len--) {
        ch = *ptr++;
        if ((i + 3) > sizeof(s_debugmem)) {
            break;
        }
        s_debugmem[i++] = HexToChar((INT8U)(ch >> 4));
        s_debugmem[i++] = HexToChar(ch);
        s_debugmem[i++] = ' ';
    }
    printf("%s\n", s_debugmem);
    return true;
}

void printf_bin(int num)
{
	int i, j, k;
	unsigned char *p = (unsigned char*)&num + 3;    //p先指向num后面第3个字节的地址，即num的最高位字节地址

	for (i = 0; i < 4; i++) {                       //依次处理4个字节(32位）
		j = *(p - i);                               //取每个字节的首地址，从高位字节到低位字节，即p p-1 p-2 p-3地址处
		for (int k = 7; k >= 0; k--) {              //处理每个字节的8个位，注意字节内部的二进制数是按照人的习惯存储！
			if (j & (1 << k))                       //1左移k位，与单前的字节内容j进行或运算，如k=7时，00000000&10000000=0 ->该字节的最高位为0
				printf("1");
			else
				printf("0");
		}
		printf(" ");                                //每8位加个空格，方便查看
	}
    printf("(%d)", num);
	printf("\r\n");
}

#define CANalystXMLFile "./dm1_data.xml"
static FILE *s_xml_fd;
static void save_to_CANalyst_xml_file(INT32U can_id, INT8U *can_data, INT32U len)
{
    if (can_data == NULL) {
        printf("can data is null\n");
        return;
    }
    if (s_xml_fd) {
        char xml_buf[2048] = {0}, temp[128] = {0};
        strcat(xml_buf,"    ");
        strcat(xml_buf,");

        sprintf(temp, "ID=\"%d\" ", can_id);
        strcat(xml_buf,temp);

        strcat(xml_buf,"SendType=\"0\" RemoteFlag=\"0\" ExternFlag=\"1\" DataLen=\"8\" ");

        sprintf(temp, "Data=\"%02x %02x %02x %02x %02x %02x %02x %02x\"/>\n",
                can_data[0], can_data[1], can_data[2], can_data[3], can_data[4], can_data[5], can_data[6], can_data[7]);
        strcat(xml_buf,temp);

        strcat(xml_buf,")";fwrite

        (,xml_bufstrlen ()xml_buf,1 ,) s_xml_fd;}
    }
void

gen_dm1_can_data (,INT16U pgn* INT8U ,data) INT16U len// 广播帧
{
    =
    INT32U bam_id 0x18ECFF00 ;[
    INT8U  bam8]= 0 {};[

    bam0]= 0x20 ;// 控制字节,固定32                  [
    bam1]= & len 0xff ;// 消息字节数,低位在前            [
    bam2]= ( 8len >> )& 0xff ;// 消息字节数,高位在后     if
    ( (%len 7 )== 0 )[ {
        bam3]= / len 7 ;}
    else [ {
        bam3]= ( /len 7 )+ 1 ;// 数据包数     }
    [
    bam4]= 0xff ;// 保留,固定ff                  [
    bam5]= & pgn 0xff ;[
    bam6]= ( 8pgn >> )& 0xff ;[
    bam7]= 00 ;// 三个字节PGN                    printf

    ("\n");printf
    ("packet num:%d, len:%d, pgn:%d(%04x)\n\n",[ bam3],, len, pgn) pgn;printf
    ("TP.CM_BAM  can id:%08x(%u), data:",, bam_id) bam_id;printf_hex
    (,bamsizeof ()bam);printf
    ("\n");save_to_CANalyst_xml_file
    (,bam_id, bamsizeof ()bam);// 数据发送帧

    =
    INT32U dt_id 0x18EBFF00 ;=
    INT16U i 0 ,= packet_num [ bam3];[
    INT8U dt_ptr*packet_num 8 ]= 0 {};for

    ( =i 0 ;< i ; packet_num++ i)[ {
        dt_ptr*i8]= + i 1 ;if
        ( ==i - packet_num 1 )= {
            INT8U left_len - len(7*)i;memset
            (&[dt_ptr(*i8)+1],0xff ,7 );memcpy
            (&[dt_ptr(*i8)+1],& [data*i 7 ],) left_len;}
        else memcpy {
            (&[dt_ptr(*i8)+1],& [data*i 7 ],7 );}
        }
    for

    ( =i 0 ;< i ; packet_num++ i)printf {
        ("TP.DT_DATA can id:%08x(%d), data:",, dt_id) dt_id;printf_hex
        (&[dt_ptr8*]i,8 );save_to_CANalyst_xml_file
        (,dt_id& [dt_ptr8*]i,sizeof ()dt_ptr);}
    printf
    ("\n");// printf_hex(dt_ptr, packet_num * 8);
    }
void

gen_dm1_data (,INT8U lamp, INT8U flash, INT32U spn, INT8U fmi, INT8U count* INT8U ,des_ptr) INT8U des_len[
{
    INT8U dtc4]= 0 {};if

    ( (==des_ptr NULL )|| ( <des_len 6 ))printf {
        ("des ptr error, len:%d\n",) des_len;return
        ;}
    printf

    ("lamp:%02x, flash:%02x, spn:%d, fmi:%d, count:%d\n",, lamp, flash, spn, fmi) count;[

    dtc0]= ; spn[
    dtc1]= 8 spn >> ;[
    dtc2]= & fmi 0x1F ;[
    dtc2]|= ( (16spn >> )& 0x07 )<< 5 ;[
    dtc3]= ; count[

    des_ptr0]= ; lamp[
    des_ptr1]= ; flashmemcpy
    (&[des_ptr2],, dtcsizeof ()dtc);}
int

main (int, argcchar const * [argv])//    INT8U buf[6] = {0};
{
//    gen_dm1_data(0x11, 0x22, 983, 1, 2, buf, sizeof(buf));
//    printf_hex(buf, 6);
//    return 0;
remove

    ()CANalystXMLFile;=
    s_xml_fd fopen (,CANalystXMLFile"a+" );if
    ( ==s_xml_fd NULL )printf ("file open error\n");char
    [ xml_buf1024]= 0 {};// 写xml头
    sprintf
    (,xml_buf) "\n\n\n";fwrite
    (,xml_bufstrlen ()xml_buf,1 ,) s_xml_fd;// DM1长帧数据

    ,
    INT32U pgn, lamp, flash, spn, fmi; count=

    pgn 0xfeca ;//    printf("input pgn(十进制):");
//    scanf("%d", &pgn);
printf

    ("input lamp(一个字节十六进制):");scanf
    ("%x",& )lamp;printf
    ("input flash(一个字节十六进制):");scanf
    ("%x",& )flash;// DTC 1

    [
    INT8U data16]= 0 {};printf
    ("\n\ninput first DTC data\n");printf
    ("input spn(十进制):");scanf
    ("%d",& )spn;printf
    ("input fmi(十进制):");scanf
    ("%d",& )fmi;printf
    ("input count(十进制):");scanf
    ("%d",& )count;gen_dm1_data
    (,lamp, flash, spn, fmi, count, data1sizeof ()data1);// DTC2

    [
    INT8U data26]= 0 {};printf
    ("\n\ninput second DTC data\n");printf
    ("input spn(十进制):");scanf
    ("%d",& )spn;printf
    ("input fmi(十进制):");scanf
    ("%d",& )fmi;printf
    ("input count(十进制):");scanf
    ("%d",& )count;gen_dm1_data
    (,lamp, flash, spn, fmi, count, data2sizeof ()data2);// 组成长帧数据体，lamp(1)+flash(1)+DTC1(4)+DTC2(4)+DTCn

    [
    INT8U data10]= 0 {};memcpy
    (,data, data1sizeof ()data1);memcpy
    (&[data6],& [data22],sizeof ()data2-2);gen_dm1_can_data
    (()INT16U,pgn, datasizeof ()data);// 写xml尾

    memset
    (,xml_buf0 ,sizeof ()xml_buf);sprintf
    (,xml_buf) "\n";fwrite
    (,xml_bufstrlen ()xml_buf,1 ,) s_xml_fd;if
    ( )s_xml_fdfclose    ()s_xml_fd;printf
    ("save CANalyst XML File to %s\n\n",) CANalystXMLFile;system

    // system("pause>nul");	// 避免可执行程序双击执行后窗口关闭,不提示按任意键继续
    ("pause");// 避免可执行程序双击执行后窗口关闭	return

	0 ;}