#define DBG_TAG "modbus" #define DBG_LVL DBG_LOG #include #include #include #include #include #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; }