Merge branch 'master' of ssh://master.iot-yun.com:2280/apue

guowenxue

2019-06-26 448a7c81fb0d7cda298c7faad8e407aa4cb70315

Merge branch 'master' of ssh://master.iot-yun.com:2280/apue

 ch8_tlv/crc-itu-t.c

New file
@@ -0,0 +1,95 @@
/*

 *      crc-itu-t.c

 *

 * This source code is licensed under the GNU General Public License,

 * Version 2. See the file COPYING for more details.

 */



#include "crc-itu-t.h"



/** CRC table for the CRC ITU-T V.41 0x0x1021 (x^16 + x^12 + x^15 + 1) */

const unsigned short crc_itu_t_table[256] = {

    0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50a5, 0x60c6, 0x70e7,

    0x8108, 0x9129, 0xa14a, 0xb16b, 0xc18c, 0xd1ad, 0xe1ce, 0xf1ef,

    0x1231, 0x0210, 0x3273, 0x2252, 0x52b5, 0x4294, 0x72f7, 0x62d6,

    0x9339, 0x8318, 0xb37b, 0xa35a, 0xd3bd, 0xc39c, 0xf3ff, 0xe3de,

    0x2462, 0x3443, 0x0420, 0x1401, 0x64e6, 0x74c7, 0x44a4, 0x5485,

    0xa56a, 0xb54b, 0x8528, 0x9509, 0xe5ee, 0xf5cf, 0xc5ac, 0xd58d,

    0x3653, 0x2672, 0x1611, 0x0630, 0x76d7, 0x66f6, 0x5695, 0x46b4,

    0xb75b, 0xa77a, 0x9719, 0x8738, 0xf7df, 0xe7fe, 0xd79d, 0xc7bc,

    0x48c4, 0x58e5, 0x6886, 0x78a7, 0x0840, 0x1861, 0x2802, 0x3823,

    0xc9cc, 0xd9ed, 0xe98e, 0xf9af, 0x8948, 0x9969, 0xa90a, 0xb92b,

    0x5af5, 0x4ad4, 0x7ab7, 0x6a96, 0x1a71, 0x0a50, 0x3a33, 0x2a12,

    0xdbfd, 0xcbdc, 0xfbbf, 0xeb9e, 0x9b79, 0x8b58, 0xbb3b, 0xab1a,

    0x6ca6, 0x7c87, 0x4ce4, 0x5cc5, 0x2c22, 0x3c03, 0x0c60, 0x1c41,

    0xedae, 0xfd8f, 0xcdec, 0xddcd, 0xad2a, 0xbd0b, 0x8d68, 0x9d49,

    0x7e97, 0x6eb6, 0x5ed5, 0x4ef4, 0x3e13, 0x2e32, 0x1e51, 0x0e70,

    0xff9f, 0xefbe, 0xdfdd, 0xcffc, 0xbf1b, 0xaf3a, 0x9f59, 0x8f78,

    0x9188, 0x81a9, 0xb1ca, 0xa1eb, 0xd10c, 0xc12d, 0xf14e, 0xe16f,

    0x1080, 0x00a1, 0x30c2, 0x20e3, 0x5004, 0x4025, 0x7046, 0x6067,

    0x83b9, 0x9398, 0xa3fb, 0xb3da, 0xc33d, 0xd31c, 0xe37f, 0xf35e,

    0x02b1, 0x1290, 0x22f3, 0x32d2, 0x4235, 0x5214, 0x6277, 0x7256,

    0xb5ea, 0xa5cb, 0x95a8, 0x8589, 0xf56e, 0xe54f, 0xd52c, 0xc50d,

    0x34e2, 0x24c3, 0x14a0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405,

    0xa7db, 0xb7fa, 0x8799, 0x97b8, 0xe75f, 0xf77e, 0xc71d, 0xd73c,

    0x26d3, 0x36f2, 0x0691, 0x16b0, 0x6657, 0x7676, 0x4615, 0x5634,

    0xd94c, 0xc96d, 0xf90e, 0xe92f, 0x99c8, 0x89e9, 0xb98a, 0xa9ab,

    0x5844, 0x4865, 0x7806, 0x6827, 0x18c0, 0x08e1, 0x3882, 0x28a3,

    0xcb7d, 0xdb5c, 0xeb3f, 0xfb1e, 0x8bf9, 0x9bd8, 0xabbb, 0xbb9a,

    0x4a75, 0x5a54, 0x6a37, 0x7a16, 0x0af1, 0x1ad0, 0x2ab3, 0x3a92,

    0xfd2e, 0xed0f, 0xdd6c, 0xcd4d, 0xbdaa, 0xad8b, 0x9de8, 0x8dc9,

    0x7c26, 0x6c07, 0x5c64, 0x4c45, 0x3ca2, 0x2c83, 0x1ce0, 0x0cc1,

    0xef1f, 0xff3e, 0xcf5d, 0xdf7c, 0xaf9b, 0xbfba, 0x8fd9, 0x9ff8,

    0x6e17, 0x7e36, 0x4e55, 0x5e74, 0x2e93, 0x3eb2, 0x0ed1, 0x1ef0

};



/**

 * crc_itu_t - Compute the CRC-ITU-T for the data buffer

 *

 * @crc:     previous CRC value

 * @buffer:  data pointer

 * @len:     number of bytes in the buffer

 *

 * Returns the updated CRC value

 */

unsigned short crc_itu_t(unsigned short crc, const unsigned char *buffer, unsigned int len)

{

    while (len--)

        crc = crc_itu_t_byte(crc, *buffer++);

    return crc;

}



int ushort_to_bytes(unsigned char *bytes, unsigned short val)

{

    int              size  = sizeof (unsigned short);

    int              i = 0;



    if( !bytes )

        return 0;



    while (size)

    {

        *(bytes + --size) = (val >> ((8 * i++) & 0xFF));

    }



    return sizeof(unsigned short);

}



unsigned short bytes_to_ushort(unsigned char *bytes, int len)

{

    int            i = 0;

    unsigned short val = 0;



    if( !bytes || len > sizeof(unsigned short) )

        return 0;



    for(i=0; i<len; i++)

    {

        val += bytes[i];



        if (i < len - 1)

            val = val << 8;

    }



    return val;

}


 ch8_tlv/crc-itu-t.h

New file
@@ -0,0 +1,55 @@
/*

 *    crc-itu-t.h - CRC ITU-T V.41 routine

 *

 * Implements the standard CRC ITU-T V.41:

 *   Width 16

 *   Poly  0x0x1021 (x^16 + x^12 + x^15 + 1)

 *   Init  0

 *

 * This source code is licensed under the GNU General Public License,

 * Version 2. See the file COPYING for more details.

 */



#ifndef CRC_ITU_T_H

#define CRC_ITU_T_H



#define MAGIC_CRC           0x1E50



extern const unsigned short  crc_itu_t_table[256];





/**

 * crc_itu_t - Compute the CRC-ITU-T for the data buffer

 *

 * @crc:     previous CRC value, we use $IoT_MAGIC_CRC

 * @buffer:  data pointer

 * @len:     number of bytes in the buffer

 *

 * Returns the updated CRC value

 */

extern unsigned short crc_itu_t(unsigned short magic_crc, const unsigned char *buffer, unsigned int len);





/*

 * ushort_to_bytes - Convert  unsigned short CRC16 value to two bytes

 * @bytes:    two bytes CRC16 value saving buffer, buffer size must more than 2 bytes

 * @crc:    crc_itu_t() compute returnd value( unsigned short CRC16 checksum)

 */

extern int ushort_to_bytes(unsigned char *bytes, unsigned short val);





/*

 * bytes_to_ushort - Convert two bytes mode CRC value into unsigned short CRC16 value 
 * @bytes:    bytes mode CRC value first byte position

 * @len:      bytes mode CRC value length

 */

extern unsigned short bytes_to_ushort(unsigned char *bytes, int len);





static inline unsigned short crc_itu_t_byte(unsigned short crc, const unsigned char data)

{

    return (crc << 8) ^ crc_itu_t_table[((crc >> 8) ^ data) & 0xff];

}



#endif /* CRC_ITU_T_H */




 ch8_tlv/makefile

New file
@@ -0,0 +1,11 @@

BINAME=tlv_sample

all: 
    gcc *.c -o ${BINAME}

clean:
    rm -f ${BINAME}

run: all
    ./${BINAME}

 ch8_tlv/tlv_sample.c

New file
@@ -0,0 +1,222 @@
/*********************************************************************************
 *      Copyright:  (C) 2019 LingYun IoT studio
 *                  All rights reserved.
 *
 *       Filename:  tlv_sample.c
 *    Description:  This file 
 *                 
 *        Version:  1.0.0(03/27/2019)
 *         Author:  Guo Wenxue <guowenxue@gmail.com>
 *      ChangeLog:  1, Release initial version on "03/27/2019 09:20:25 PM"
 *                 
 ********************************************************************************/

#include <stdio.h>
#include <string.h>
#include "crc-itu-t.h"

#define OFF                0
#define ON                 1

#define BUFSIZE            128

/* TLV Packet format: 
 *
 *+------------+---------+------------+-----------+-----------+
 *| Header(1B) | Tag(1B) | Length(1B) | Value(1B) | CRC16(2B) |
 *+------------+---------+------------+-----------+-----------+
 */

#define PACK_HEADER        0xFD

/* Tag definition */
enum
{
    TAG_LOGON=1,
    TAG_CAMERA,
    TAG_LED,
};

/* TLV packet fixed segement size, 1B Head, 1B Tag, 1B length, 2B CRC16, total 5B. */
#define TLV_FIXED_SIZE     5

/* TLV packet Minimum size is fixed bytes + 1 byte data */
#define TLV_MIN_SIZE       (TLV_FIXED_SIZE+1)

int packtlv_logon(char *buf, int size, char *pwd);
int packtlv_led(char *buf, int size, int cmd);
void dump_buf(char *data, int len);

int main(int argc, char **argv)
{
    char          buf[BUFSIZE];
    int           bytes;

    bytes = packtlv_led(buf, sizeof(buf), ON);

           /* print every byte in the buffer as HEX and corresponding charactor, 
      which is not printable charactor will be instead as '?' */
    dump_buf(buf, bytes);

    bytes = packtlv_logon(buf, sizeof(buf), "iot@yun");

    dump_buf(buf, bytes);

    return 0;
}


int packtlv_logon(char *buf, int size, char *pwd)
{
    unsigned short      crc16 = 0;
    int                 pack_len = 0;
    int                 data_len = 0;
    int                 ofset = 0; /* index position for the buf */

    if(!buf || !pwd || size<TLV_MIN_SIZE )
    {
        printf("Invalid input arguments\n");
        return 0;
    }

    /* Packet head */
    buf[ofset] = PACK_HEADER;
    ofset += 1;

    /* Tag */
    buf[ofset] = TAG_LOGON;
    ofset += 1;

    /* $pwd too long maybe result buffer overflow, so we need check the buffer 
     * is large enuf or not. If buf size is not enuf we will truncate $pwd string */
    if( strlen(pwd) <= size-TLV_FIXED_SIZE )
        data_len = strlen(pwd);
    else
        data_len = size-TLV_FIXED_SIZE;

    /* Length, this packet is passwd length+5Byte () */
    pack_len = data_len + TLV_FIXED_SIZE;

    buf[ofset] = pack_len;
    ofset += 1;

    memcpy(&buf[ofset], pwd, data_len);
    ofset += data_len;

    /* Calc CRC16 checksum value from Packet Head(buf[0])~ Value(buf[ofset]) */
    crc16 = crc_itu_t(MAGIC_CRC, buf, ofset);

    /* Append the 2 Bytes CRC16 checksum value into the last two bytes in packet buffer */
    ushort_to_bytes(&buf[ofset], crc16);
    ofset += 2;

    return ofset;
}



int packtlv_led(char *buf, int size, int cmd)
{
    unsigned short      crc16;
    int                 pack_len = TLV_FIXED_SIZE+1; /* Only 1 byte data */

    if(!buf || size<TLV_MIN_SIZE )
    {
        printf("Invalid input arguments\n");
        return 0;
    }

    /* Packet head */
    buf[0] = PACK_HEADER;

    /* Tag */
    buf[1] = TAG_LED;

    /* Length, this packet total 6 bytes */
    buf[2] = pack_len;

    /* Value */
    buf[3] = (OFF==cmd) ? 0x00 : 0x01;

    /* Calc CRC16 checksum value from Packet Head(buf[0])~ Packet Value(buf[3]) */
    crc16 = crc_itu_t(MAGIC_CRC, buf, 4);

    /* Append the 2 Bytes CRC16 checksum value into the last two bytes in packet buffer */
    ushort_to_bytes(&buf[4], crc16);

    return pack_len;
}


/*+------------------------------+
 *|  dump_buf() implement code   |
 *+------------------------------+*/

#define LINELEN 81
#define CHARS_PER_LINE 16

static char *print_char =
    "                "
    "                "
    " !\"#$%&'()*+,-./"
    "0123456789:;<=>?"
    "@ABCDEFGHIJKLMNO"
    "PQRSTUVWXYZ[\\]^_"
    "`abcdefghijklmno"
    "pqrstuvwxyz{|}~ "
    "                "
    "                "
    " ???????????????"
    "????????????????"
    "????????????????"
    "????????????????"
    "????????????????"
    "????????????????";

/* print every byte in the buffer as HEX and corresponding charactor, which is not printable charactor will be instead as '?' */
void dump_buf(char *data, int len)
{
    int rc;
    int idx;
    char prn[LINELEN];
    char lit[CHARS_PER_LINE + 1];
    char hc[4];
    short line_done = 1;

    rc = len;
    idx = 0;
    lit[CHARS_PER_LINE] = '\0';

    while (rc > 0)
    {
        if (line_done)
            snprintf(prn, LINELEN, "%08X: ", idx);
        do
        {
            unsigned char c = data[idx];
            snprintf(hc, 4, "%02X ", c);
            strncat(prn, hc, 4);
            lit[idx % CHARS_PER_LINE] = print_char[c];
            ++idx;
        } while (--rc > 0 && (idx % CHARS_PER_LINE != 0));

        line_done = (idx % CHARS_PER_LINE) == 0;

        if (line_done)
            printf("%s  %s\n", prn, lit);
        else if (rc == 0)
            strncat(prn, "   ", LINELEN);
    }

    if (!line_done)
    {
        lit[(idx % CHARS_PER_LINE)] = '\0';

        while ((++idx % CHARS_PER_LINE) != 0)
            strncat(prn, "   ", LINELEN);

        printf("%s  %s\n", prn, lit);

    }
}


 ch8_tlv/树莓派监控项目TLV报文格式.docx

Binary files differ

 ch8_tlv/浅谈自定义通讯协议TLV.docx

Binary files differ