37 changed files with 885 additions and 74 deletions
-
63.cproject
-
2app_protocols/transmit_disfection_protocol/transmit_disfection_protocol.hpp
-
2stm32basic
-
2stm32components
-
BINucomponents/hmp110/HMM100-Datasheet-B210813ZH.pdf
-
BINucomponents/hmp110/HMP110 DOC247480-A Simplified Models.zip
-
BINucomponents/hmp110/HMP110-Datasheet-B210852ZH.pdf
-
BINucomponents/hmp110/HMP60-and-HMP110-Series-User-Guide-M211060EN-L.pdf
-
118ucomponents/hmp110/hmp110.cpp
-
70ucomponents/hmp110/hmp110.hpp
-
BINucomponents/hpp272/HPP272-使用说明书.pdf
-
8ucomponents/hpp272/README.md
-
71ucomponents/hpp272/hpp272.cpp
-
78ucomponents/hpp272/hpp272.hpp
-
BINucomponents/hpp272/过氧化氢传感器读取.zip
-
107ucomponents/preportional_valve/preportional_valve_ctrl.cpp
-
51ucomponents/preportional_valve/preportional_valve_ctrl.hpp
-
BINucomponents/pxx_pressure_sensor_driver/DP600--RS485通讯说明书V0.1.docx
-
BINucomponents/pxx_pressure_sensor_driver/HCP300新说明书.pdf
-
BINucomponents/pxx_pressure_sensor_driver/P100标准MODBUS RTU通讯协议.pdf
-
243ucomponents/pxx_pressure_sensor_driver/pxx_pressure_sensor_bus.cpp
-
73ucomponents/pxx_pressure_sensor_driver/pxx_pressure_sensor_bus.hpp
-
5ucomponents/ucomponents.hpp
-
7usrc/app_main.cpp
-
19usrc/base/appdep.hpp
-
14usrc/base/appthread/app_period_task_mgr.hpp
-
1usrc/base/appthread/work_queue.hpp
-
1usrc/base/config_service.cpp
-
4usrc/base/config_service.hpp
-
2usrc/base/device_info.hpp
-
1usrc/base/idtable/IdMgr.cpp
-
3usrc/base/idtable/IdMgr.hpp
-
3usrc/base/protocol_processer_utils.hpp
-
3usrc/base/utils/formula.hpp
-
4usrc/base/utils/halutils.hpp
-
2usrc/module/h2o2_sensor.cpp
-
2usrc/module/proportional_valve_ctrl.hpp
@ -1 +1 @@ |
|||
Subproject commit 049e643b139652247636ddb1564345bb299b1aab |
|||
Subproject commit 54ccfa2fd5128c9a2f243eb2394a51cb47595f13 |
|||
@ -1 +1 @@ |
|||
Subproject commit bcca882e2f1f8688716246e4d376230dbc4de28f |
|||
Subproject commit d387a6d07dd669a43fafc96016635e3b95830a0c |
|||
@ -0,0 +1,118 @@ |
|||
#include "hmp110.hpp"
|
|||
|
|||
#include "stm32components/modbus/modbus_block_host.hpp"
|
|||
|
|||
using namespace iflytop; |
|||
|
|||
#define TAG "HMP110"
|
|||
|
|||
void HMP110::init(ModbusBlockHost* modbusBlockHost) { |
|||
m_modbusBlockHost = modbusBlockHost; |
|||
m_id = 240; |
|||
|
|||
m_cache_lock.init(); |
|||
m_chlock.init(); |
|||
} |
|||
|
|||
bool HMP110::readReg03(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal, int overtimems) { //
|
|||
zlock_guard lck(m_chlock); |
|||
// ZLOGI(TAG, "=============== readReg03 %d %d", slaveAddr, regAddr);
|
|||
bool ret = m_modbusBlockHost->readReg03(slaveAddr, regAddr, regVal, overtimems); |
|||
// ZLOGI(TAG, "=============== END%d", ret);
|
|||
|
|||
|
|||
return ret; |
|||
} |
|||
bool HMP110::readReg03Muti(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal, int regNum, int overtimems) { //
|
|||
zlock_guard lck(m_chlock); |
|||
// ZLOGI(TAG, "=============== readReg03Muti %d %d %d", slaveAddr, regAddr, regNum);
|
|||
bool ret = m_modbusBlockHost->readReg03Muti(slaveAddr, regAddr, regVal, regNum, overtimems); |
|||
// ZLOGI(TAG, "=============== END%d", ret);
|
|||
return ret; |
|||
} |
|||
bool HMP110::ping(int id) { |
|||
int16_t val = 0; |
|||
return readReg03(id, 0x1F00, (uint16_t*)&val, 300); |
|||
} |
|||
|
|||
void HMP110::setid(int32_t id) { m_id = id; } |
|||
|
|||
void HMP110::read_calibration_date(int32_t* year, int32_t* month, int32_t* day) { // TODO
|
|||
*year = 1; |
|||
*month = 2; |
|||
*day = 3; |
|||
} |
|||
int32_t HMP110::read_errorcode() { |
|||
int16_t val = 0; |
|||
bool suc = readReg03(m_id, 0x0200, (uint16_t*)&val, 300); |
|||
if (!suc) { |
|||
return -1; |
|||
} |
|||
|
|||
if (val == 1) { |
|||
return 0; |
|||
} |
|||
uint16_t ecodebuf[2]; |
|||
suc = readReg03Muti(m_id, 0x0203, ecodebuf, 2, 300); |
|||
|
|||
uint32_t ecode = ecodebuf[0] | (((uint32_t)ecodebuf[1]) << 16); |
|||
return ecode; |
|||
} |
|||
|
|||
bool HMP110::read_reg(int32_t add, uint16_t* val, size_t len) { |
|||
// ZLOGI(TAG, "read_reg %x %d", add, len);
|
|||
bool suc = readReg03Muti(m_id, add, val, len, 300); |
|||
// if (suc)
|
|||
// for (size_t i = 0; i < len; i++) {
|
|||
// ZLOGI(TAG, "val[%d] = %d", i, val[i]);
|
|||
// }
|
|||
// else
|
|||
// ZLOGE(TAG, "read_reg failed");
|
|||
return suc; |
|||
} |
|||
|
|||
bool HMP110::read_sensor_data(hmp110_sensordata_t* sensordata) { |
|||
uint16_t buf[7]; |
|||
bool suc = readReg03Muti(m_id, 0x0100, buf, 7, 300); |
|||
if (!suc) { |
|||
return false; |
|||
} |
|||
|
|||
sensordata->rh = buf[0]; |
|||
sensordata->temp = buf[1]; |
|||
sensordata->df_ptemp = buf[2]; |
|||
sensordata->ah = buf[3]; |
|||
sensordata->mr = buf[4]; |
|||
sensordata->wet_bulb_temp = buf[5]; |
|||
sensordata->enthalpy = buf[6]; |
|||
return true; |
|||
} |
|||
|
|||
void HMP110::updateSensorDataAndErrorcode() { |
|||
bool suc = read_sensor_data(&m_rdbuf); |
|||
osDelay(100); |
|||
int32_t errorcode = read_errorcode(); |
|||
if (errorcode != 0) { |
|||
ZLOGE(TAG, "errorcode: %d", errorcode); |
|||
} |
|||
if (!suc) { |
|||
ZLOGE(TAG, "read_sensor_data failed"); |
|||
errorcode = -1; |
|||
} |
|||
|
|||
{ |
|||
zlock_guard lck(m_cache_lock); |
|||
m_cachedata = m_rdbuf; |
|||
m_cache_errorcode = errorcode; |
|||
} |
|||
} |
|||
|
|||
int32_t HMP110::read_cache_errorcode() { |
|||
zlock_guard lck(m_cache_lock); |
|||
return m_cache_errorcode; |
|||
} |
|||
bool HMP110::read_cache_sensor_data(hmp110_sensordata_t* sensordata) { |
|||
zlock_guard lck(m_cache_lock); |
|||
*sensordata = m_cachedata; |
|||
return true; |
|||
} |
|||
@ -0,0 +1,70 @@ |
|||
#pragma once
|
|||
#include <stddef.h>
|
|||
#include <stdio.h>
|
|||
|
|||
#include "stm32basic/stm32basic.hpp"
|
|||
#include "stm32components/stm32components.hpp"
|
|||
|
|||
namespace iflytop { |
|||
|
|||
#define PXX_PRESSURE_SENSOR_NUM 10
|
|||
|
|||
class HMP110 { |
|||
public: |
|||
#pragma pack(1)
|
|||
|
|||
typedef struct { |
|||
int16_t rh; // Relative humidity %RH * 10
|
|||
int16_t temp; // Temperature °C * 10
|
|||
int16_t df_ptemp; // Dew/frost point temperature °C * 10
|
|||
int16_t ah; // Absolute humidity g/m3 * 10
|
|||
int16_t mr; // Mixing ratio g/kg * 10
|
|||
int16_t wet_bulb_temp; // Wet-bulb temperature °C * 10
|
|||
int16_t enthalpy; // Enthalpy kJ/kg * 10
|
|||
} hmp110_sensordata_t; |
|||
#pragma pack()
|
|||
|
|||
private: |
|||
/***********************************************************************************************************************
|
|||
* DATA * |
|||
***********************************************************************************************************************/ |
|||
|
|||
ModbusBlockHost* m_modbusBlockHost = NULL; |
|||
int32_t m_id = 0; |
|||
zmutex m_lock; |
|||
|
|||
hmp110_sensordata_t m_rdbuf; |
|||
|
|||
hmp110_sensordata_t m_cachedata; |
|||
int32_t m_cache_errorcode = 0; |
|||
zmutex m_cache_lock; |
|||
|
|||
zmutex m_chlock; |
|||
|
|||
public: |
|||
/***********************************************************************************************************************
|
|||
* FUNC * |
|||
***********************************************************************************************************************/ |
|||
|
|||
void init(ModbusBlockHost* modbusBlockHost); |
|||
|
|||
bool ping(int id); |
|||
bool ping(); |
|||
void setid(int32_t id); |
|||
|
|||
void read_calibration_date(int32_t* year, int32_t* month, int32_t* day); // TODO
|
|||
int32_t read_errorcode(); // ret == -1 表明设备不在线
|
|||
bool read_reg(int32_t add, uint16_t* val, size_t len); |
|||
bool read_sensor_data(hmp110_sensordata_t* sensordata); |
|||
|
|||
void updateSensorDataAndErrorcode(); |
|||
|
|||
int32_t read_cache_errorcode(); |
|||
bool read_cache_sensor_data(hmp110_sensordata_t* sensordata); |
|||
|
|||
public: |
|||
bool readReg03(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal, int overtimems); |
|||
bool readReg03Muti(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal, int regNum, int overtimems); |
|||
}; |
|||
|
|||
} // namespace iflytop
|
|||
@ -0,0 +1,8 @@ |
|||
|
|||
``` |
|||
注意事项: |
|||
1. 串口停止位是2位 |
|||
2. 波特率19200 |
|||
3. 默认ID 240 |
|||
|
|||
``` |
|||
@ -0,0 +1,71 @@ |
|||
#include "hpp272.hpp"
|
|||
|
|||
#include "stm32components/modbus/modbus_block_host.hpp"
|
|||
|
|||
using namespace iflytop; |
|||
|
|||
#define TAG "HPP272"
|
|||
|
|||
void HPP272::init(ModbusBlockHost* modbusBlockHost) { |
|||
m_modbusBlockHost = modbusBlockHost; |
|||
m_id = 240; |
|||
|
|||
m_cache_lock.init(); |
|||
} |
|||
bool HPP272::ping(int id) { |
|||
int16_t val = 0; |
|||
return m_modbusBlockHost->readReg03(id, 0x1F00, (uint16_t*)&val, 100); |
|||
} |
|||
|
|||
void HPP272::setid(int32_t id) { m_id = id; } |
|||
|
|||
void HPP272::read_calibration_date(int32_t* year, int32_t* month, int32_t* day) { // TODO
|
|||
*year = 0; |
|||
*month = 0; |
|||
*day = 0; |
|||
} |
|||
int32_t HPP272::read_errorcode() { |
|||
int16_t val = 0; |
|||
bool suc = m_modbusBlockHost->readReg03(m_id, 0x0200, (uint16_t*)&val, 100); |
|||
if (!suc) { |
|||
return -1; |
|||
} |
|||
|
|||
// 0 = Status OK.
|
|||
// 1 = Critical error,maintenance needed.
|
|||
// 2 = Error, device may recover automatically.
|
|||
// 4 = Warning.
|
|||
// 8 = Notification.
|
|||
// 16 = Calibration enabled
|
|||
|
|||
return val; |
|||
} |
|||
|
|||
bool HPP272::read_reg(int32_t add, uint16_t* val, size_t len) { return m_modbusBlockHost->readReg03Muti(m_id, add, val, len, 100); } |
|||
|
|||
bool HPP272::read_sensor_data(hpp272_data_t* sensordata) { //
|
|||
return m_modbusBlockHost->readReg03Muti(m_id, 0x0100, (uint16_t*)sensordata, sizeof(*sensordata) / 2, 100); |
|||
} |
|||
|
|||
void HPP272::updateSensorDataAndErrorcode() { |
|||
if (!read_sensor_data(&m_readbuf)) { |
|||
return; |
|||
} |
|||
int32_t errorcode = read_errorcode(); |
|||
|
|||
{ |
|||
zlock_guard lck(m_cache_lock); |
|||
m_cachedata = m_readbuf; |
|||
m_cache_errorcode = errorcode; |
|||
} |
|||
} |
|||
|
|||
int32_t HPP272::read_cache_errorcode() { |
|||
zlock_guard lck(m_cache_lock); |
|||
return m_cache_errorcode; |
|||
} |
|||
bool HPP272::read_cache_sensor_data(hpp272_data_t* sensordata) { |
|||
zlock_guard lck(m_cache_lock); |
|||
*sensordata = m_cachedata; |
|||
return true; |
|||
} |
|||
@ -0,0 +1,78 @@ |
|||
#pragma once
|
|||
#include <stddef.h>
|
|||
#include <stdio.h>
|
|||
|
|||
#include "stm32basic/stm32basic.hpp"
|
|||
#include "stm32components/stm32components.hpp"
|
|||
|
|||
namespace iflytop { |
|||
|
|||
#define PXX_PRESSURE_SENSOR_NUM 10
|
|||
|
|||
class HPP272 { |
|||
public: |
|||
#pragma pack(1)
|
|||
typedef struct { |
|||
uint16_t hydrogen_peroxide_volume; // ppm 0x0100
|
|||
uint16_t h2o_h2o2_rs; // %RS * 100
|
|||
uint16_t temperature1; // °C * 100
|
|||
uint16_t relative_humidity; // %RH * 100
|
|||
uint16_t absolute_hydrogen_peroxide; // mg/m3
|
|||
uint16_t h2o_h2o2dew_point_temperature; // °C * 100
|
|||
uint16_t reserved1; //
|
|||
uint16_t water_volume; // ppm
|
|||
uint16_t water_vapor_pressure; // hpa
|
|||
uint16_t absolute_humidity; // g/m3
|
|||
uint16_t water_vapor_saturation_pressure_h2o; // hpa
|
|||
uint16_t temperature2; // °C * 100
|
|||
uint16_t h2o2_vapor_pressure; // hpa
|
|||
uint16_t water_vapor_saturation_pressure_h2o_h2o2; // hpa
|
|||
} hpp272_data_t; |
|||
#pragma pack()
|
|||
|
|||
private: |
|||
/***********************************************************************************************************************
|
|||
* DATA * |
|||
***********************************************************************************************************************/ |
|||
|
|||
ModbusBlockHost* m_modbusBlockHost = NULL; |
|||
|
|||
int32_t m_id = 0; |
|||
zmutex m_lock; |
|||
|
|||
hpp272_data_t m_readbuf; |
|||
|
|||
hpp272_data_t m_cachedata; |
|||
int32_t m_cache_errorcode = 0; |
|||
zmutex m_cache_lock; |
|||
|
|||
public: |
|||
/***********************************************************************************************************************
|
|||
* FUNC * |
|||
***********************************************************************************************************************/ |
|||
|
|||
/**
|
|||
* @brief |
|||
* |
|||
* @param modbusBlockHost |
|||
*/ |
|||
void init(ModbusBlockHost* modbusBlockHost); |
|||
|
|||
bool ping(int id); |
|||
bool ping(); |
|||
void setid(int32_t id); |
|||
|
|||
void read_calibration_date(int32_t* year, int32_t* month, int32_t* day); // TODO
|
|||
int32_t read_errorcode(); // see datasheet page83
|
|||
bool read_reg(int32_t add, uint16_t* val, size_t len); |
|||
bool read_sensor_data(hpp272_data_t* sensordata); |
|||
|
|||
void updateSensorDataAndErrorcode(); |
|||
|
|||
int32_t read_cache_errorcode(); |
|||
bool read_cache_sensor_data(hpp272_data_t* sensordata); |
|||
|
|||
public: |
|||
}; |
|||
|
|||
} // namespace iflytop
|
|||
@ -0,0 +1,107 @@ |
|||
#include "preportional_valve_ctrl.hpp"
|
|||
|
|||
#include "transmit_disfection_protocol/transmit_disfection_protocol.hpp"
|
|||
using namespace iflytop; |
|||
using namespace zscanprotocol; |
|||
|
|||
#define WORK_STATE_REG 0x0000
|
|||
#define CTRL_STATE_REG 0x0001
|
|||
#define POS_STATE_REG 0x0013
|
|||
#define OVERTIME 30
|
|||
#define TAG "PreportionalValveCtrl"
|
|||
|
|||
void PreportionalValveCtrl::initialize(UART_HandleTypeDef* huart) { m_modbusBlockHost.initialize(huart); } |
|||
|
|||
int32_t PreportionalValveCtrl::writeReg06(uint8_t slaveAddr, uint16_t regAddr, uint16_t regVal) { |
|||
// 重发三次
|
|||
for (size_t i = 0; i < 3; i++) { |
|||
int32_t err = m_modbusBlockHost.writeReg06(slaveAddr, regAddr, regVal, OVERTIME); |
|||
if (err == 0) return 0; |
|||
} |
|||
return err::kerr_subdevice_offline; |
|||
} |
|||
int32_t PreportionalValveCtrl::readReg03(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal) { |
|||
// 重发三次
|
|||
for (size_t i = 0; i < 3; i++) { |
|||
int32_t err = m_modbusBlockHost.readReg03(slaveAddr, regAddr, regVal, OVERTIME); |
|||
if (err == 0) return 0; |
|||
} |
|||
return err::kerr_subdevice_offline; |
|||
} |
|||
|
|||
int32_t PreportionalValveCtrl::setValvePos(int32_t valueid, int32_t pos) { //
|
|||
int32_t ret = 0; |
|||
if (valueid > 255 || valueid < 1) { |
|||
return err::kerr_invalid_param; |
|||
} |
|||
ret = writeReg06(valueid, CTRL_STATE_REG, pos); |
|||
if (!ret) return err::kerr_subdevice_offline; |
|||
|
|||
m_last_set_valve_ticket = HAL_GetTick(); |
|||
m_targetpos[valueid] = pos; |
|||
return 0; |
|||
} |
|||
|
|||
int32_t PreportionalValveCtrl::getValvePos(int32_t valueid, int32_t* pos) { |
|||
int32_t ret = 0; |
|||
if (valueid > 255 || valueid < 1) { |
|||
return err::kerr_invalid_param; |
|||
} |
|||
|
|||
uint16_t pos16 = 0; |
|||
ret = readReg03(valueid, POS_STATE_REG, &pos16); |
|||
if (!ret) return err::kerr_subdevice_offline; |
|||
|
|||
*pos = pos16; |
|||
return 0; |
|||
} |
|||
int32_t PreportionalValveCtrl::getValveOrderPos(int32_t valueid, int32_t* pos) { |
|||
int32_t ret = 0; |
|||
if (valueid > 255 || valueid < 1) { |
|||
return err::kerr_invalid_param; |
|||
} |
|||
|
|||
uint16_t pos16 = 0; |
|||
ret = readReg03(valueid, CTRL_STATE_REG, &pos16); |
|||
if (!ret) return err::kerr_subdevice_offline; |
|||
|
|||
*pos = pos16; |
|||
return 0; |
|||
} |
|||
|
|||
int32_t PreportionalValveCtrl::isBusy(int32_t valueid, int32_t* busy) { |
|||
#if 1
|
|||
int32_t orderpos = 0; |
|||
int32_t pos = 0; |
|||
int32_t err = 0; |
|||
|
|||
#if 0
|
|||
err = getValveOrderPos(valueid, &orderpos); |
|||
if (err != 0) return err; |
|||
#endif
|
|||
orderpos = m_targetpos[valueid]; |
|||
|
|||
err = getValvePos(valueid, &pos); |
|||
if (err != 0) return err; |
|||
|
|||
if (abs(m_targetpos[valueid] - pos) <= 11) { |
|||
*busy = 0; |
|||
} else { |
|||
*busy = 1; |
|||
} |
|||
return 0; |
|||
#endif
|
|||
} |
|||
|
|||
int32_t PreportionalValveCtrl::getValveWorkState(int32_t valueid, int32_t* state) { |
|||
int32_t ret = 0; |
|||
if (valueid > 255 || valueid < 1) { |
|||
return err::kerr_invalid_param; |
|||
} |
|||
|
|||
uint16_t state16 = 0; |
|||
ret = readReg03(valueid, WORK_STATE_REG, &state16); |
|||
if (!ret) return err::kerr_subdevice_offline; |
|||
*state = state16; |
|||
return 0; |
|||
} |
|||
@ -0,0 +1,51 @@ |
|||
#pragma once
|
|||
#include <stddef.h>
|
|||
#include <stdio.h>
|
|||
|
|||
#include "base/config_service.hpp"
|
|||
#include "stm32components/modbus/modbus_block_host.hpp"
|
|||
#include "stm32basic/stm32basic.hpp"
|
|||
#include "stm32components/stm32components.hpp"
|
|||
|
|||
/**
|
|||
* @brief |
|||
* |
|||
* https://iflytop1.feishu.cn/wiki/GQwCwHMqFiaJRwks80ncwaYKnSe
|
|||
*/ |
|||
|
|||
namespace iflytop { |
|||
using namespace std; |
|||
class PreportionalValveCtrl { |
|||
public: |
|||
typedef enum { |
|||
kstate_stop = 0x0, |
|||
kstate_running_forward = 0xaa, |
|||
kstate_running_backward = 0xbb, |
|||
kstate_err_state = 0xea, |
|||
} work_state_t; |
|||
|
|||
private: |
|||
/* data */ |
|||
ModbusBlockHost m_modbusBlockHost; |
|||
int32_t val = 0; |
|||
uint32_t m_last_set_valve_ticket = 0; |
|||
uint16_t m_targetpos[255]; |
|||
|
|||
public: |
|||
PreportionalValveCtrl() {}; |
|||
~PreportionalValveCtrl() {}; |
|||
|
|||
void initialize(UART_HandleTypeDef* huart); |
|||
int32_t setValvePos(int32_t valueid, int32_t pos); |
|||
int32_t getValvePos(int32_t valueid, int32_t* pos); |
|||
int32_t getValveOrderPos(int32_t valueid, int32_t* pos); |
|||
int32_t isBusy(int32_t valueid, int32_t* busy); |
|||
int32_t getValveWorkState(int32_t valueid, int32_t* state); |
|||
|
|||
private: |
|||
|
|||
int32_t writeReg06(uint8_t slaveAddr, uint16_t regAddr, uint16_t regVal); |
|||
int32_t readReg03(uint8_t slaveAddr, uint16_t regAddr, uint16_t* regVal); |
|||
}; |
|||
|
|||
} // namespace iflytop
|
|||
@ -0,0 +1,243 @@ |
|||
#include "pxx_pressure_sensor_bus.hpp"
|
|||
|
|||
|
|||
using namespace iflytop; |
|||
|
|||
#define TAG "PxxSensor"
|
|||
|
|||
/**
|
|||
* @brief |
|||
* |
|||
* |
|||
* p100_protocol |
|||
* 0x0000:从机地址位 |
|||
* p600_protocol |
|||
* 0x0018H:从机地址位 |
|||
* |
|||
* |
|||
* |
|||
* 程序编写指标参考: |
|||
* 响应频率 : 模拟信号输出≤500Hz、数字信号输出≤5Hz |
|||
* 指令回执响应时间 : 20ms |
|||
* |
|||
* 推荐指令间隔: |
|||
* 指令间隔至少30ms |
|||
*/ |
|||
|
|||
#define OVERTIME_MS 50
|
|||
|
|||
static const char* protocolType2Str(PXXPressureSensorBus::protocol_type_t type) { |
|||
switch (type) { |
|||
case PXXPressureSensorBus::kp100_protocol: |
|||
return "P100"; |
|||
case PXXPressureSensorBus::kdp600_protocol: |
|||
return "DP600"; |
|||
case PXXPressureSensorBus::kothers_protocol: |
|||
return "OTHERS"; |
|||
default: |
|||
return "UNKNOWN"; |
|||
} |
|||
} |
|||
|
|||
static const char* p100uint2Str(uint8_t uint) { |
|||
switch (uint) { |
|||
case 0: |
|||
return "Mpa"; |
|||
case 1: |
|||
return "kpa"; |
|||
case 2: |
|||
return "pa"; |
|||
case 3: |
|||
return "bar"; |
|||
case 4: |
|||
return "Mbar"; |
|||
case 5: |
|||
return "kgcm2"; |
|||
case 6: |
|||
return "psi"; |
|||
case 7: |
|||
return "mh2o"; |
|||
case 8: |
|||
return "mh2o"; |
|||
default: |
|||
return "UNKNOWN"; |
|||
} |
|||
} |
|||
|
|||
/***********************************************************************************************************************
|
|||
* GLOBAL * |
|||
***********************************************************************************************************************/ |
|||
|
|||
static osThreadId PxxPressureSensorThread; |
|||
static void onPxxPressureSensorThreadStart(void const* argument) { ((PXXPressureSensorBus*)argument)->threadFuncStart(); } |
|||
|
|||
/***********************************************************************************************************************
|
|||
* CLASS * |
|||
***********************************************************************************************************************/ |
|||
|
|||
bool PXXPressureSensorBus::pingDevice(int id) { |
|||
uint16_t add = 0; |
|||
bool suc = m_modbusBlockHost->readReg03(id, 0x0000, &add, OVERTIME_MS); |
|||
return suc; |
|||
} |
|||
|
|||
bool PXXPressureSensorBus::tryProbeProtocolP100(int id, sensor_t* sensor) { |
|||
uint16_t add = 0; |
|||
bool suc = m_modbusBlockHost->readReg03(id, 0x0000, &add, OVERTIME_MS); |
|||
if (!suc) { |
|||
return false; |
|||
} |
|||
if (id != add) { |
|||
return false; |
|||
} |
|||
osDelay(10); |
|||
int16_t val[6] = {0}; |
|||
|
|||
suc = m_modbusBlockHost->readReg03Muti(id, 0x02, (uint16_t*)val, 5, 50); |
|||
if (!suc) { |
|||
return false; |
|||
} |
|||
sensor->p100_sensor_info.precision = val[1]; |
|||
sensor->p100_sensor_info.pressure_unit = val[0]; |
|||
sensor->p100_sensor_info.value = val[2]; |
|||
sensor->p100_sensor_info.zero_point = val[3]; |
|||
sensor->p100_sensor_info.range_full_point = val[4]; |
|||
|
|||
sensor->id = id; |
|||
sensor->type = kp100_protocol; |
|||
sensor->detected = true; |
|||
|
|||
return true; |
|||
} |
|||
bool PXXPressureSensorBus::tryProbeProtocolDP600(int id, sensor_t* sensor) { |
|||
uint16_t add = 0; |
|||
bool suc = m_modbusBlockHost->readReg03(id, 0x0018, &add, OVERTIME_MS); |
|||
// ZLOGI(TAG, "tryProbeProtocolDP600 id:%d add:%d suc:%d", id, add, suc);
|
|||
if (!suc) { |
|||
return false; |
|||
} |
|||
if (id != add) { |
|||
return false; |
|||
} |
|||
|
|||
sensor->id = id; |
|||
sensor->type = kdp600_protocol; |
|||
sensor->detected = true; |
|||
return true; |
|||
} |
|||
|
|||
void PXXPressureSensorBus::probeSensor() { |
|||
memset(sensors, 0, sizeof(sensors)); |
|||
for (size_t i = 1; i < ZARRAY_SIZE(sensors); i++) { |
|||
osDelay(30); |
|||
bool pingSuc = false; |
|||
pingSuc = pingDevice(i); |
|||
ZLOGI(TAG, "pingDevice id:%d,%s", i, pingSuc ? "online" : "offline"); |
|||
if (pingSuc) { |
|||
sensorNum++; |
|||
if (tryProbeProtocolP100(i, &sensors[i])) continue; |
|||
osDelay(30); |
|||
if (tryProbeProtocolDP600(i, &sensors[i])) continue; |
|||
|
|||
sensors[i].id = i; |
|||
sensors[i].type = kothers_protocol; |
|||
sensors[i].detected = true; |
|||
} else { |
|||
} |
|||
} |
|||
|
|||
/**
|
|||
* @brief DUMP Sensor State |
|||
*/ |
|||
ZLOGI(TAG, "detect pressure sensor list:(%d)", sensorNum); |
|||
for (size_t i = 0; i < ZARRAY_SIZE(sensors); i++) { |
|||
if (sensors[i].detected) { |
|||
if (sensors[i].type == kp100_protocol) { |
|||
ZLOGI(TAG, " Sensor[%d] id:%d ptype:%s precision:%d unit:%s zero:%d full:%d", i, sensors[i].id, //
|
|||
protocolType2Str(sensors[i].type), //
|
|||
sensors[i].p100_sensor_info.precision, //
|
|||
p100uint2Str(sensors[i].p100_sensor_info.pressure_unit), //
|
|||
sensors[i].p100_sensor_info.zero_point, //
|
|||
sensors[i].p100_sensor_info.range_full_point); |
|||
} else { |
|||
ZLOGI(TAG, " Sensor[%d] id:%d ptype:%s detected:%d", i, sensors[i].id, protocolType2Str(sensors[i].type), sensors[i].detected); |
|||
} |
|||
} |
|||
} |
|||
ZLOGI(TAG, "end"); |
|||
initedEnd = true; |
|||
} |
|||
|
|||
void PXXPressureSensorBus::threadFuncStart() { |
|||
/**
|
|||
* @brief 枚举传感器设备 |
|||
*/ |
|||
probeSensor(); |
|||
/**
|
|||
* @brief 周期采集传感器数据 |
|||
*/ |
|||
while (true) { |
|||
//
|
|||
for (size_t i = 0; i < ZARRAY_SIZE(sensors); i++) { |
|||
if (!sensors[i].detected) { |
|||
continue; |
|||
} |
|||
|
|||
bool suc = false; |
|||
|
|||
if (sensors[i].type == kp100_protocol) { |
|||
int16_t val = 0; |
|||
suc = m_modbusBlockHost->readReg03(i, 0x0004, (uint16_t*)&val, OVERTIME_MS); |
|||
{ |
|||
zlock_guard l(m_lock); |
|||
if (suc) sensors[i].val = val; |
|||
sensors[i].online = suc; |
|||
} |
|||
} else if (sensors[i].type == kdp600_protocol) { |
|||
int16_t val = 0; |
|||
suc = m_modbusBlockHost->readReg03(i, 0x0000, (uint16_t*)&val, OVERTIME_MS); |
|||
|
|||
{ |
|||
zlock_guard l(m_lock); |
|||
if (suc) sensors[i].val = val; |
|||
sensors[i].online = suc; |
|||
} |
|||
} else { |
|||
{ |
|||
zlock_guard l(m_lock); |
|||
sensors[i].online = false; |
|||
} |
|||
continue; |
|||
} |
|||
osDelay(50); |
|||
} |
|||
osDelay(50); |
|||
} |
|||
} |
|||
|
|||
void PXXPressureSensorBus::init(UART_HandleTypeDef* huart) { |
|||
//
|
|||
m_lock.init(); |
|||
|
|||
m_modbusBlockHost = new ModbusBlockHost(); //
|
|||
m_modbusBlockHost->initialize(huart); |
|||
|
|||
osThreadDef(PxxPressureSensorThread, onPxxPressureSensorThreadStart, osPriorityNormal, 0, 1024); |
|||
PxxPressureSensorThread = osThreadCreate(osThread(PxxPressureSensorThread), this); |
|||
|
|||
while (!initedEnd) { |
|||
osDelay(10); |
|||
} |
|||
} |
|||
bool PXXPressureSensorBus::readData(int32_t id, int16_t* data) { |
|||
zlock_guard l(m_lock); |
|||
if (id < 0 || id >= ZARRAY_SIZE(sensors)) { |
|||
return false; |
|||
} |
|||
if (!sensors[id].online) { |
|||
return false; |
|||
} |
|||
*data = sensors[id].val; |
|||
return true; |
|||
} |
|||
void PXXPressureSensorBus::probe() {} |
|||
@ -0,0 +1,73 @@ |
|||
#pragma once
|
|||
#include <stddef.h>
|
|||
#include <stdio.h>
|
|||
|
|||
#include "stm32components/modbus/modbus_block_host.hpp"
|
|||
|
|||
namespace iflytop { |
|||
|
|||
#define PXX_PRESSURE_SENSOR_NUM 10
|
|||
|
|||
class PXXPressureSensorBus { |
|||
public: |
|||
/***********************************************************************************************************************
|
|||
* STRUCT * |
|||
***********************************************************************************************************************/ |
|||
|
|||
typedef enum { |
|||
kp100_protocol, |
|||
kdp600_protocol, |
|||
kothers_protocol, |
|||
} protocol_type_t; |
|||
|
|||
typedef struct { |
|||
uint8_t precision; // 0,1,2,3
|
|||
uint8_t pressure_unit; // 0:map,1:kpa,2:pa
|
|||
int16_t value; |
|||
int16_t zero_point; |
|||
int16_t range_full_point; |
|||
} p100_sensor_info_t; |
|||
|
|||
typedef struct { |
|||
uint16_t id; |
|||
protocol_type_t type; |
|||
bool detected; |
|||
bool online; |
|||
p100_sensor_info_t p100_sensor_info; |
|||
|
|||
int32_t val; |
|||
} sensor_t; |
|||
|
|||
private: |
|||
/***********************************************************************************************************************
|
|||
* DATA * |
|||
***********************************************************************************************************************/ |
|||
|
|||
ModbusBlockHost* m_modbusBlockHost; |
|||
bool initedEnd = false; |
|||
zmutex m_lock; |
|||
|
|||
public: |
|||
sensor_t sensors[PXX_PRESSURE_SENSOR_NUM] = {0}; |
|||
int32_t sensorNum = 0; |
|||
|
|||
public: |
|||
/***********************************************************************************************************************
|
|||
* FUNC * |
|||
***********************************************************************************************************************/ |
|||
void init(UART_HandleTypeDef *huart); |
|||
bool readData(int32_t id, int16_t* data); |
|||
|
|||
private: |
|||
void probe(); |
|||
|
|||
public: |
|||
void threadFuncStart(); |
|||
|
|||
bool pingDevice(int id); |
|||
bool tryProbeProtocolP100(int id, sensor_t* sensor); |
|||
bool tryProbeProtocolDP600(int id, sensor_t* sensor); |
|||
void probeSensor(); |
|||
}; |
|||
|
|||
} // namespace iflytop
|
|||
@ -0,0 +1,5 @@ |
|||
#pragma once
|
|||
#include "hmp110/hmp110.hpp"
|
|||
#include "hpp272/hpp272.hpp"
|
|||
#include "preportional_valve/preportional_valve_ctrl.hpp"
|
|||
#include "pxx_pressure_sensor_driver/pxx_pressure_sensor_bus.hpp"
|
|||
Write
Preview
Loading…
Cancel
Save
Reference in new issue