QXZ_QXZL/low3/applications/modbus_read.c

#define DBG_TAG "modbus"
#define DBG_LVL DBG_LOG
#include <rtdbg.h>
#include <rtthread.h>
#include <stdlib.h>
#include <main.h>
#include <string.h>
#include "sys.h"
#include "iap.h"
#include "modbus_host.h"

void (*RS485_ReceiveData)(uint8_t);
extern void Usart_SendString(UART_HandleTypeDef huart, char *str);
extern LOAR_Tx loar_t;
extern void LOAR_SEND_DATA(uint8_t address, uint8_t Inclued_Sensor);

Sensor sensor[MAX_SENSOR_NUM] = {0};
uint16_t Read_data[MAX_SENSOR_NUM * 2] = {0};
/*
void RS485_SendBuf(uint8_t *_ucaBuf, uint16_t _usLen, UART_HandleTypeDef *uart)
{
    HAL_GPIO_WritePin(R_D_GPIO_Port, R_D_Pin, GPIO_PIN_SET);//PA8

    HAL_UART_Transmit(uart, _ucaBuf, _usLen, 1000);//USART2

    HAL_GPIO_WritePin(R_D_GPIO_Port, R_D_Pin, GPIO_PIN_RESET);
}
*/
//485发送相关
void RS485_SendBuf(uint8_t *_ucaBuf, uint16_t _usLen, UART_HandleTypeDef *uart)
{
    if(uart->Instance == USART3)
    {
        HAL_GPIO_WritePin(RX_STU_Port, RX_STU_Pin, GPIO_PIN_SET);//PC13
        HAL_UART_Transmit(uart, _ucaBuf, _usLen, 1000);//USART3
        HAL_GPIO_WritePin(RX_STU_Port, RX_STU_Pin, GPIO_PIN_RESET);
    }
    else if(uart->Instance == USART2){
        HAL_GPIO_WritePin(R_D_GPIO_Port, R_D_Pin, GPIO_PIN_SET);//PA8
        HAL_UART_Transmit(uart, _ucaBuf, _usLen, 1000);//USART2
        HAL_GPIO_WritePin(R_D_GPIO_Port, R_D_Pin, GPIO_PIN_RESET);
    }

}


/**
 * @brief 获取数值的位数
 *
 * @param val 数值
 * @return uint8_t 返回位数
 */
uint8_t GetValueLen(int32_t val)
{
    uint8_t cnt = 1;
    int32_t m = val;
    while (m > 9)
    {
        m /= 10;
        cnt++;
    }
    // rt_kprintf("%d is %d len\n",val , cnt);
    return cnt;
}
/**
 * @brief 给定val和factor 生成eval
 *
 * @param val 原始数据
 * @param factor 因数
 * @param eval eval的指针
 */
void GenerateValue(int16_t val, int factor, char *eval)
{

    if (val == 0x7FFF)
    {
        rt_sprintf(eval, "-99.99");
        return;
    }

    if (factor > 0)
    {
        rt_sprintf((char *)eval, "%d", val * factor);
    }
    else if (factor < 0)
    {
        switch (GetValueLen(abs(factor)))
        {
        // 当负的单位数 不做处理
        case 1:
        {
        }
        break;
        // 当负的两位数 例如-10
        case 2:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%01d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%01d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        // 当负的三位数 例如-100
        case 3:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%02d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%02d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        // 当负的四位数 例如-1000      //flash不够了 4位小数先不考虑
        case 4:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%03d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%03d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        case 5://当负的五位数10000
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%04d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%04d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        case 6://当负的五位数100000  10W
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%04d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%04d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        default:
            break;
        }
    }
    // 不对factor == 0的情况做处理

    // rt_kprintf("Gen %s\n",eval);
}

/**
 * @brief 给定val和factor 生成eval
 *
 * @param val 原始数据
 * @param factor 因数
 * @param eval eval的指针
 */
void GenerateValue_32(int32_t val, int factor, char *eval)//实际写的是 传感器.eValue 值
{


    if (val == 0x7FFF)
    {
        rt_sprintf(eval, "-99.99");
        return;
    }

    if (factor > 0)
    {
        rt_sprintf((char *)eval, "%d", val * factor);
    }
    else if (factor < 0)
    {
        switch (GetValueLen(abs(factor)))
        {
        // 当负的单位数 不做处理
        case 1:
        {
        }
        break;
        // 当负的两位数 例如-10
        case 2:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%01d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%01d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        // 当负的三位数 例如-100
        case 3:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%02d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%02d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        // 当负的四位数 例如-1000      //flash不够了 4位小数先不考虑
        case 4:
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%03d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%03d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        case 5://当负的五位数10000
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%04d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%04d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        case 6://当负的五位数100000  10W
        {
            if (val >= 0)
            {
                rt_sprintf((char *)eval, "%d.%04d", val / abs(factor), val % abs(factor));
            }
            else
            {
                rt_sprintf((char *)eval, "-%d.%04d", abs(val) / abs(factor), abs(val) % abs(factor));
            }
        }
        break;
        default:
            break;
        }
    }
    // 不对factor == 0的情况做处理

    // rt_kprintf("Gen %s\n",eval);
}

























extern uint8_t Init_ok;

/**
 *
 *
 *          READ_MODBUS_DATA_1()
 *          该函数可根据sensor中存放的传感器参数 自动进行解析和运算
 *          并将结果组包为字符串 存于sensor[a].eValue
 *          若读取失败 evalue使用 -99.99填充 平台显示N/A
 *
 *
 */
int16_t READ_MODBUS_DATA_1(uint8_t times)
{
    static uint8_t Once_delay = 1;
    static uint8_t Once_Start = 1;  //判断是不是第一次进来  第一次进来延时300ms


    //第一次进来延时300ms
    if (Once_Start == 1)
    {
        Once_Start = 0;
        rt_thread_mdelay(300);
    }





    for (uint8_t a = 0; a < MAX_SENSOR_NUM; a++) //   a < 16
    {
        if (sensor[a].cfged == 1) // 要素模型已经配置
        {
            sensor[a].value = 0;

            if (Once_delay == 1 && strstr(sensor[a].eNum, "120") != NULL) // 碰上CO2的话 给个延时10秒
            {
                Once_delay = 0;
                rt_thread_mdelay(10000);//10s延时
            }

            if (times == 0) // 刚开始 先赋-99
            {
                rt_sprintf(sensor[a].eValue, "-99.99");
            }

            if (MODH_ReadParam_03H(sensor[a].sensor_addr, sensor[a].start_reg, sensor[a].count, a))
            {
                for (uint8_t b = 0; b < sensor[a].d_length; b++)
                {
                    sensor[a].value += Read_data[sensor[a].d_pos + b] << ((sensor[a].d_length - 1 - b) * 16);
                }
#if Node_Type == LTE
                if ((g_tModH.fAck03H == 1) && (sensor[a].en_corr == 1) && a <= (sys_info.Sensor_num - 1)) // LTE做要素数据修正
                {
                    sensor[a].value *= sensor[a].times;
                    sensor[a].value /= sensor[a].divide;
                    sensor[a].value += sensor[a].plus;
                    sensor[a].value -= sensor[a].minus;
                }
#endif
                memset(sensor[a].eValue, 0, sizeof(sensor[a].eValue));

                // 使用新算法对eval进行生成
                if (sensor[a].d_length == 1)
                {
                    GenerateValue(sensor[a].value, sensor[a].factor, (char *)sensor[a].eValue); // 16位整型
                }
                else
                {
                    GenerateValue_32(sensor[a].value, sensor[a].factor, (char *)sensor[a].eValue); // 32位整型
                }
                if (g_tModH.fAck03H) // 读到数据了就读3次 读不到就读6次
                {
                    Init_ok++;
                    g_tModH.fAck03H = 0;
                }
                rt_kprintf("s%d %s ", a, sensor[a].eValue);
            }
            else
            {
                rt_kprintf("s%d × ", a);
            }
        }
        rt_thread_mdelay(500); // 每个要素结束的间隔
        memset(Read_data, 0, sizeof(Read_data));
    }






    rt_kprintf("\n");
    return 1;
}