9 changed files with 220 additions and 17 deletions
-
5.gitmodules
-
5.vscode/settings.json
-
2sdk
-
1transmit_disinfection_protocol_v1
-
152usrc/h2o2_sensor.cpp
-
44usrc/h2o2_sensor.hpp
-
18usrc/hardware.cpp
-
8usrc/main.cpp
-
2usrc/main.hpp
@ -1,3 +1,6 @@ |
|||||
[submodule "sdk"] |
[submodule "sdk"] |
||||
path = sdk |
path = sdk |
||||
url = zwsd@192.168.1.3:manufacturer_stm32/iflytop_sdk.git |
|
||||
|
url = zwsd@192.168.1.3:p_transmit_disinfection/transmit_disinfection_iflytop_sdk_v1.git |
||||
|
[submodule "transmit_disinfection_protocol_v1"] |
||||
|
path = transmit_disinfection_protocol_v1 |
||||
|
url = zwsd@192.168.1.3:p_transmit_disinfection/transmit_disinfection_protocol_v1.git |
@ -1 +1 @@ |
|||||
Subproject commit f6f7900b876e6a4a6b2c5ebe6bd26b5f1b1fbe0a |
|
||||
|
Subproject commit b20f4cc2e42244d6dd21566dd1a4b1a48ddc64a9 |
@ -0,0 +1 @@ |
|||||
|
Subproject commit c39bd364d809a9a6ad965c83fd3ea28c67514317 |
@ -0,0 +1,152 @@ |
|||||
|
#include "h2o2_sensor.hpp"
|
||||
|
|
||||
|
#include <stdio.h>
|
||||
|
#include <string.h>
|
||||
|
|
||||
|
#include "adc.h"
|
||||
|
|
||||
|
#ifdef HAL_CAN_MODULE_ENABLED
|
||||
|
|
||||
|
using namespace iflytop; |
||||
|
using namespace zcr; |
||||
|
#define TAG "H2O2Sensor"
|
||||
|
|
||||
|
void H2O2Sensor::initialize() { |
||||
|
} |
||||
|
|
||||
|
void H2O2Sensor::regSubmodule(int id, UART_HandleTypeDef* huart, uint8_t modbusid) { |
||||
|
ZASSERT(huart != NULL); |
||||
|
m_sensorId = id; |
||||
|
m_modbusid = modbusid; |
||||
|
modbusBlockHost.initialize(huart); |
||||
|
|
||||
|
readSensorData(); |
||||
|
} |
||||
|
|
||||
|
uint32_t H2O2Sensor::readAvgAdcVal() { |
||||
|
// 读取15次,取中间十个数取平均值
|
||||
|
|
||||
|
uint32_t adcv[15] = {0}; // 15次采样
|
||||
|
for (int i = 0; i < 15; i++) { |
||||
|
adcv[i] = readAdcVal(); |
||||
|
} |
||||
|
|
||||
|
// 冒泡排序
|
||||
|
for (int i = 0; i < 15; i++) { |
||||
|
for (int j = 0; j < 15 - i - 1; j++) { |
||||
|
if (adcv[j] > adcv[j + 1]) { |
||||
|
uint32_t temp = adcv[j]; |
||||
|
adcv[j] = adcv[j + 1]; |
||||
|
adcv[j + 1] = temp; |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
uint32_t sum = 0; |
||||
|
for (int i = 2; i < 12; i++) { |
||||
|
sum += adcv[i]; |
||||
|
} |
||||
|
return sum / 10; |
||||
|
} |
||||
|
|
||||
|
uint32_t H2O2Sensor::readAdcVal() { |
||||
|
ADC_ChannelConfTypeDef sConfig; // 通道初始化
|
||||
|
|
||||
|
uint8_t id; |
||||
|
|
||||
|
sConfig.Channel = ADC_CHANNEL_9; |
||||
|
sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES; // 采用周期239.5周期
|
||||
|
sConfig.Rank = 1; |
||||
|
HAL_ADC_ConfigChannel(&hadc1, &sConfig); |
||||
|
|
||||
|
uint32_t adcv = 0; //
|
||||
|
HAL_ADC_Start(&hadc1); // 启动转换
|
||||
|
HAL_ADC_PollForConversion(&hadc1, 30); // 等待转化结束
|
||||
|
adcv = HAL_ADC_GetValue(&hadc1); // 求和
|
||||
|
HAL_ADC_Stop(&hadc1); // 停止转换
|
||||
|
return adcv; // 返回平均值
|
||||
|
} |
||||
|
|
||||
|
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; |
||||
|
|
||||
|
hpp272_data_t* H2O2Sensor::readSensorData() { |
||||
|
sensordatacache.hydrogen_peroxide_volume = 0; |
||||
|
sensordatacache.h2o_h2o2_rs = 0; |
||||
|
sensordatacache.temperature1 = 20 * 100; |
||||
|
sensordatacache.relative_humidity = 0; |
||||
|
|
||||
|
static uint16_t rxbuf[128]; |
||||
|
static hmp110_sensordata_t sensordata; |
||||
|
|
||||
|
memset(rxbuf, 0, sizeof(rxbuf)); |
||||
|
bool suc = modbusBlockHost.readReg03Muti(1, 0x0100, rxbuf, 7, 300); |
||||
|
if (suc) { |
||||
|
sensordata.rh = rxbuf[0]; |
||||
|
sensordata.temp = rxbuf[1]; |
||||
|
sensordata.df_ptemp = rxbuf[2]; |
||||
|
sensordata.ah = rxbuf[3]; |
||||
|
sensordata.mr = rxbuf[4]; |
||||
|
sensordata.wet_bulb_temp = rxbuf[5]; |
||||
|
sensordata.enthalpy = rxbuf[6]; |
||||
|
|
||||
|
sensordatacache.temperature1 = sensordata.temp * 10; |
||||
|
sensordatacache.relative_humidity = sensordata.rh * 10; |
||||
|
} else { |
||||
|
ZLOGI(TAG, "readSensorData fail"); |
||||
|
sensordatacache.temperature1 = 0; |
||||
|
sensordatacache.relative_humidity = 0; |
||||
|
} |
||||
|
|
||||
|
uint32_t adcv = readAvgAdcVal(); |
||||
|
float mv = adcv / 4095.0 * 3.3 * 1000; |
||||
|
float ma = mv / 150.0; |
||||
|
float ppm = (ma - 4) / (20 - 4) * 2000; |
||||
|
if (ppm < 0) ppm = 0; |
||||
|
|
||||
|
ZLOGI(TAG, " i:%f ppm:%f temp:%d rh:%d", ma, ppm, sensordatacache.temperature1, sensordatacache.relative_humidity); |
||||
|
|
||||
|
sensordatacache.hydrogen_peroxide_volume = ppm; |
||||
|
if (sensordatacache.hydrogen_peroxide_volume < 10) { |
||||
|
sensordatacache.hydrogen_peroxide_volume = 0; |
||||
|
} |
||||
|
// sensordatacache.hydrogen_peroxide_volume = 9973;
|
||||
|
|
||||
|
return &sensordatacache; |
||||
|
} |
||||
|
|
||||
|
void H2O2Sensor::onRceivePacket(Cmdheader_t* cmdheader, int sensorId) { |
||||
|
if (sensorId != m_sensorId) { |
||||
|
return; |
||||
|
} |
||||
|
|
||||
|
// hpp272_data_t* sensordata = readSensorData();
|
||||
|
// if (sensordata) {
|
||||
|
// txbuff[0] = sensorId;
|
||||
|
// txbuff[1] = 0;
|
||||
|
// memcpy(txbuff + 2, sensordata, sizeof(hpp272_data_t));
|
||||
|
// m_zcanReceiver->sendAck(cmdheader, txbuff, sizeof(hpp272_data_t) + 2);
|
||||
|
// } else {
|
||||
|
// ZLOGE(TAG, "hpp272 is null");
|
||||
|
// int16_t errcode = 1002; // 设备不在线
|
||||
|
// m_zcanReceiver->sendErrorAck(cmdheader, errcode);
|
||||
|
// }
|
||||
|
// return;
|
||||
|
} |
||||
|
|
||||
|
void H2O2Sensor::onRceivePacket(CanPacketRxBuffer* rxbuf, uint8_t* packet, size_t len) { |
||||
|
Cmdheader_t* cmdheader = (Cmdheader_t*)packet; |
||||
|
if (cmdheader->cmdid == kcmd_m211887_operation && cmdheader->subcmdid == 0) { |
||||
|
uint8_t id = cmdheader->data[0]; |
||||
|
onRceivePacket(cmdheader, id); |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
#endif
|
@ -0,0 +1,44 @@ |
|||||
|
//
|
||||
|
// Created by zwsd
|
||||
|
//
|
||||
|
|
||||
|
#pragma once
|
||||
|
#include "sdk/hal/zhal.hpp"
|
||||
|
//
|
||||
|
#include "sdk\components\vaisala_sensor\hpp272.hpp"
|
||||
|
#include "sdk\components\zcanreceiver\zcanreceiver.hpp"
|
||||
|
|
||||
|
#ifdef HAL_CAN_MODULE_ENABLED
|
||||
|
namespace iflytop { |
||||
|
|
||||
|
class H2O2Sensor : public ZCanRceiverListener { |
||||
|
private: |
||||
|
uint8_t txbuff[sizeof(hpp272_data_t) + 10]; |
||||
|
int32_t m_sensorId = -1; |
||||
|
int32_t m_modbusid = -1; |
||||
|
|
||||
|
hpp272_data_t sensordatacache; |
||||
|
|
||||
|
ModbusBlockHost modbusBlockHost; |
||||
|
|
||||
|
public: |
||||
|
H2O2Sensor(/* args */) {} |
||||
|
~H2O2Sensor() {} |
||||
|
|
||||
|
public: |
||||
|
void initialize(); |
||||
|
void regSubmodule(int id, UART_HandleTypeDef* huart, uint8_t modbusid); |
||||
|
virtual hpp272_data_t* readSensorData(); |
||||
|
|
||||
|
public: |
||||
|
virtual void onRceivePacket(CanPacketRxBuffer* rxbuf, uint8_t* packet, size_t len); |
||||
|
virtual void onRceivePacket(Cmdheader_t* cmdheader, int sensorId); |
||||
|
|
||||
|
private: |
||||
|
void loop(); |
||||
|
uint32_t readAdcVal(); |
||||
|
uint32_t readAvgAdcVal(); |
||||
|
}; |
||||
|
} // namespace iflytop
|
||||
|
|
||||
|
#endif
|
Write
Preview
Loading…
Cancel
Save
Reference in new issue