armfly/User/app/fly_uart/fly_uart.c

/*-------------------------------------------------------------------------------------------------
** module: samkoon communication
** com   : 485\Modbus Rtu
** data  : 2022-4-15
** by    : xie
-------------------------------------------------------------------------------------------------*/
#include "fly_uart.h"

INT16U misc_info_buf[BUF_LEN_128] = {0};
INT16U cell_temp_buf[BUF_LEN_512] = {0};
INT16U samkoon_txbuf[BUF_LEN_128] = {0};

/*---------------------------------------
** func ：Count_CRC
** brief：CRC cal
** para ：addr: 数据指针   num: 数量
---------------------------------------*/
unsigned short Count_CRC(const INT8U *addr, int num)
{
    unsigned short crc = 0xFFFF;
    int            i;
    while (num--)
    {
        crc ^= *addr++;
        for (i = 0; i < 8; i++)
        {
            crc = (crc & 0x0001) ? ((crc >> 1) ^ 0xA001) : (crc >> 1);
        }
    }
    return crc;
}

/*--------------------------------------------
** func ：ImportantData_TxGet
** brief：copy send data;
          soc 1th start from 0x4001;
** para : samkoon_txbuf\misc_info_buf for use
--------------------------------------------*/
void ImportantData_TxGet(INT16U pos, INT16U cnt, INT8U *des_data, INT8U *src_data)
{
    INT8U i  = 0;
    pos      = pos - 0x4001; // addr offset 4300 hex
    src_data = src_data + pos;
    des_data = des_data + 6; // cell txbuf offset:6

    for (i = pos; i < cnt; i++)
    {
        *des_data++ = *src_data++;
    }
}

/*---------------------------------------
** func ：Cell_Info_ReadOut
** brief：copy cell data
          1th start from 0x4301
** para ：none
---------------------------------------*/
void Cell_Info_ReadOut(INT16U *p)
{
    INT8U i, j;

    for (i = 0; i < 6; i++)
    {
        for (j = 0; j < 6; j++)
        {
            *p++ = 3300;
        }
    }

    //	for(i = 0;i < config_get_slave_num(); i++)   // without offset
    //  {
    //		 for(j = 0;j < bmu_get_cell_num(i); j++)
    //	   {
    //			 *p++ = 3300; //bmu_get_cell_vol(i,j);
    //		 }
    //	}
}
/*---------------------------------------
** func ：Cell_Info_TxGet
** brief: none
** para ：position \ cnt
---------------------------------------*/

void Cell_Info_TxGet(INT16U pos, INT16U cnt, INT8U *des_data, INT8U *src_data)
{
    INT8U i  = 0;
    pos      = pos - 0x4300; // addr offset 4300 hex
    src_data = src_data + pos;
    des_data = des_data + 6; // cell txbuf offset:6

    for (i = pos; i < cnt; i++)
    {
        *des_data++ = *src_data++;
    }
}

/*---------------------------------------
** func ：Temperature_ReadOut
** brief：copy temperature data,
          1th start from 0x55C1
          offset -40
** para ：none
---------------------------------------*/
void Temperature_ReadOut(INT16U *p)
{
    INT8U i, j;
    for (i = 0; i < 6; i++)
    {
        for (j = 0; j < 6; j++)
        {
            *p++ = 20;
        }
    }

    //	for(i = 0;i < config_get_slave_num(); i++)   // without offset     //PackNum = (total + (singleNum - 1))/singleNum
    //  {
    //		 for(j = 0;j < bmu_get_temp_num(i); j++)
    //	   {
    //		    *p++ = bmu_get_cell_temp(i,j);
    //		 }
    //	}
}

/*---------------------------------------
** func ：Cell_Info_TxGet
** brief: none
** para ：position \ cnt
---------------------------------------*/
void Temperature_TxGet(INT16U pos, INT16U cnt, INT8U *des_data, INT8U *src_data)
{
    INT8U i  = 0;
    pos      = pos - 0x55c0; // addr offset 55c0 hex
    src_data = src_data + pos;
    des_data = des_data + 6; // tmp txbuf offset:6

    for (i = pos; i < cnt; i++)
    {
        *des_data++ = *src_data++;
    }
}
/*---------------------------------------
** func ：Rtu_TxData_Get()
** brief: none
** para ：position \ cnt
---------------------------------------*/
void Rtu_TxData_Get(INT16U pos,
                    INT16U cnt,
                    INT16U addr_start,
                    INT8U  fotmat_offset, // fotmat_offset:3
                    INT8U *des_data,
                    INT8U *src_data)
{
    INT8U i = 0;
    if (pos < addr_start)
        return;

    pos      = pos - addr_start; // addr offset 55c0 hex
    src_data = src_data + pos * 2;
    //	des_data = des_data + fotmat_offset;
    des_data = (INT8U *)des_data + fotmat_offset;
    for (i = 2 * pos; i < 2 * cnt; i++)
    {
        *des_data++ = *src_data++;
    }
}
/*---------------------------------------
** func ：Crc_Write()
** brief: none
** para ：
---------------------------------------*/
void Crc_Write(INT8U *p, INT16U data, INT8U count)
{
    p    = p + (2 * count + 3);
    *p++ = (INT8U)data;
    *p++ = (INT8U)(data >> 8);
}
/*---------------------------------------
** func ：Small2Big()
** brief: none
** para ：
---------------------------------------*/
void Small2Big(INT16U *buf, INT16U count)
{
    INT8U  i      = 0;
    INT8U *p      = (INT8U *)buf;
    INT8U *p_next = (INT8U *)buf + 1;
    char   tmp;
    for (i = 0; i < 2 * count; i++)
    {
        tmp     = *p;
        *p      = *p_next;
        *p_next = tmp;
        p       = p + 2;
        p_next  = p_next + 2;
    }
}

/*---------------------------------------
** func ：Modbus_Head_Copy
** brief: none
** para ：
---------------------------------------*/
void Modbus_Head_Copy(INT8U *des_data, INT8U *src_data)
{
    INT8U i = 0;
    for (i = 0; i < 2; i++)
    {
        *des_data++ = *src_data++; // addr fun_code
    }
    src_data  = src_data + 3;
    *des_data = (*src_data) * 2;
    //	for(i = 0; i < 1; i++)
    //	{
    //	  *des_data++ = *src_data++;   //count
    //	}
}
/*----------------------------------------------
** @func  : samkoon_com_work
** @brief : BMS with samkoon communication
** format :  xx     xx   xx xx   xx xx    xx xx
             addr  func  -reg-  -count-   -crc-
      ans:   xx     xx   xx xx   xx....xx    xx xx
             addr  func  count-  --data--    -crc-

crc:small  other:big
-----------------------------------------------*/
void samkoon_com_work(INT8U *rec_data, void (*tx_p)(const INT8U *buf, INT16U len))
{
    INT16U          register_addr_hmi;
    INT16U          tmp_crc;
    volatile INT16U register_count;
    volatile INT8U  illegal_flag  = 0;
    INT8U           function_code = 0;

    register_addr_hmi = (rec_data[REGISTER_ADDR_H] << 8) + rec_data[REGISTER_ADDR_L];
    register_count    = (rec_data[COUNT_INDEX_H] << 8) + rec_data[COUNT_INDEX_L];
    function_code     = rec_data[FUNCTION_CODE_INDEX];

    switch (function_code)
    {
    case FUNC_03:
        if ((register_addr_hmi >= MODBUS_ADDR_RACK_REMOTE) && (register_addr_hmi < MODBUS_ADDR_RACK_REMOTE_END))
        {
            Modbus_Head_Copy((INT8U *)samkoon_txbuf, rec_data);
            // Important_Bin_ReadOut(misc_info_buf);
            Small2Big(misc_info_buf, register_count);
            Rtu_TxData_Get(register_addr_hmi, register_count, 0xc9, 3, (INT8U *)samkoon_txbuf, (INT8U *)misc_info_buf);
            tmp_crc = Count_CRC((INT8U *)samkoon_txbuf, 2 * register_count + 3);
            Crc_Write((INT8U *)samkoon_txbuf, tmp_crc, register_count);
            //				samkoon_txbuf[register_count + 2] = tmp_crc;
            tx_p((INT8U *)samkoon_txbuf, (2 * register_count + 5));
        }
        else if ((register_addr_hmi >= MODBUS_ADDR_SOC) && (register_addr_hmi < MODBUS_RACK_END))
        {
            Modbus_Head_Copy((INT8U *)samkoon_txbuf, rec_data);
            // ImportantData_Readout(misc_info_buf);
            Small2Big(misc_info_buf, register_count);
            Rtu_TxData_Get(register_addr_hmi, register_count, 0x4101, 3, (INT8U *)samkoon_txbuf, (INT8U *)misc_info_buf);
            tmp_crc = Count_CRC((INT8U *)samkoon_txbuf, 2 * register_count + 3);
            Crc_Write((INT8U *)samkoon_txbuf, tmp_crc, register_count);
            //			   	samkoon_txbuf[register_count + 2] = tmp_crc;
            tx_p((INT8U *)samkoon_txbuf, (2 * register_count + 5));
        }
        else if ((register_addr_hmi >= MODBUS_ADDR_CELL) && (register_addr_hmi < MODBUS_CELL_END))
        {
            Modbus_Head_Copy((INT8U *)samkoon_txbuf, rec_data);
            Cell_Info_ReadOut(cell_temp_buf); // read all cell data
            Small2Big(cell_temp_buf, register_count);
            Rtu_TxData_Get(register_addr_hmi, register_count, 0x4301, 3, (INT8U *)samkoon_txbuf, (INT8U *)cell_temp_buf);
            tmp_crc = Count_CRC((INT8U *)samkoon_txbuf, 2 * register_count + 3);
            Crc_Write((INT8U *)samkoon_txbuf, tmp_crc, register_count);
            //			     samkoon_txbuf[register_count + 2] = tmp_crc;
            tx_p((INT8U *)samkoon_txbuf, (2 * register_count + 5));
        }
        else if ((register_addr_hmi >= MODBUS_ADDR_TEMP) && (register_addr_hmi < MODBUS_TEMP_END))
        {
            Modbus_Head_Copy((INT8U *)samkoon_txbuf, rec_data);
            Temperature_ReadOut(cell_temp_buf); // read all temp data
            Small2Big(cell_temp_buf, register_count);
            Rtu_TxData_Get(register_addr_hmi, register_count, 0x55c1, 3, (INT8U *)samkoon_txbuf, (INT8U *)cell_temp_buf);
            tmp_crc = Count_CRC((INT8U *)samkoon_txbuf, 2 * register_count + 3);
            Crc_Write((INT8U *)samkoon_txbuf, tmp_crc, register_count);
            //			     samkoon_txbuf[register_count + 2] = tmp_crc;
            tx_p((INT8U *)samkoon_txbuf, (2 * register_count + 5));
        }
        else if ((register_addr_hmi >= MODBUS_ADDR_READ_KA) && (register_addr_hmi < MODBUS_KA_END))
        {
            Modbus_Head_Copy((INT8U *)samkoon_txbuf, rec_data);
            // Relay_Bin_Readout(misc_info_buf);
            Small2Big(misc_info_buf, register_count);
            Rtu_TxData_Get(register_addr_hmi, register_count, 0x1001, 3, (INT8U *)samkoon_txbuf, (INT8U *)misc_info_buf);
            tmp_crc = Count_CRC((INT8U *)samkoon_txbuf, 2 * register_count + 3);
            Crc_Write((INT8U *)samkoon_txbuf, tmp_crc, register_count);
            //			   	 samkoon_txbuf[register_count + 2] = tmp_crc;
            tx_p((INT8U *)samkoon_txbuf, (2 * register_count + 5));
        }
        break;
    /* do other work... */
    case FUNC_05:
        break;

    default:
        illegal_flag = 1;
        break;
    }
}

void fly_uart1_task(void)
{
    INT8U err = 0;
    //    INT8U test_buf[20] = {0};
    UartFrame_TypeDef *msg;
    INT16U             crc_check       = 0;
    INT16U             rcv_crc         = 0;
    txfun_p            Modbus_RTU_Send = Uart1_dma_Send_Data;
    while (1)
    {
        OSTimeDly(200);
        iwdg_feed(UART1_DOG);
        msg = (UartFrame_TypeDef *)OSMboxPend(uart1_mbox, 50, &err);
        if ((err == OS_ERR_NONE) && (msg->len >= 2))
        {
            crc_check = Count_CRC(msg->buf, 6);
            rcv_crc   = ((msg->buf[7] << 8) | msg->buf[6]);
            if (crc_check != rcv_crc)
            {
                continue;
            }

            samkoon_com_work(&(msg->buf[0]), Modbus_RTU_Send);
        }
    }
}

// void bms_uart0_task(void)
//{
//     INT8U err = 0;
//     INT8U test_buf[20] = {0};
//     UartFrame_TypeDef *msg;
//     while(1)
//     {
//         wtdg_feed(UART0_DOG);
//         msg = (UartFrame_TypeDef *)OSMboxPend(uart0_mbox, 50, &err);
//         if((err == OS_ERR_NONE) && (msg->len >= 2))
//         {
//             if((msg->buf[0] == 0x00) && (msg->buf[1] == 0xAA) && (msg->buf[2] == 0xBB))
//             {
//                 test_buf[0] = 0x00;
//                 test_buf[1] = 0xBB;
//                 test_buf[2] = 0xAA;
//                 Uart0_dma_Send_Data(test_buf, 3);
//             }
//         }
//     }
// }