5 changed files with 426 additions and 47 deletions
-
61.vscode/settings.json
-
2dep/iflytopcpp
-
2sh/envsetup.sh
-
277src/service/device_io_service.cpp
-
131src/service/device_io_service.hpp
@ -1 +1 @@ |
|||||
Subproject commit 2d2ac28f73d5a14aba4501831c1c52468b726a10 |
|
||||
|
Subproject commit 574b15ad972bcaae593cfc434f9f60e6d6a13ca8 |
@ -1,4 +1,281 @@ |
|||||
#include "device_io_service.hpp"
|
#include "device_io_service.hpp"
|
||||
|
|
||||
|
#include "iflytopcpp/core/components/string_util.hpp"
|
||||
|
#include "iflytopcpp/core/components/time_util.hpp"
|
||||
|
#include "iflytopcpp/core/zexception/zexception.hpp"
|
||||
using namespace iflytop; |
using namespace iflytop; |
||||
using namespace core; |
using namespace core; |
||||
using namespace std; |
using namespace std; |
||||
|
|
||||
|
const static int ksubboarddeviceid = 0x01; |
||||
|
const int kovertime = 33; |
||||
|
|
||||
|
#define EXEC_MODBUS(exptr) \
|
||||
|
int ret = exptr; \ |
||||
|
if (ret != 0) { \ |
||||
|
throw zexception( \ |
||||
|
fmt::format("[{}:{}] do {} fail, ret={},{}", __FUNCTION__, __LINE__, exptr, ret, modbusStatusToStr(ret))); \ |
||||
|
} |
||||
|
|
||||
|
void DeviceIOService::initialize() { |
||||
|
modbusMaster = shared_ptr<ModbusMaster>(new ModbusMaster()); |
||||
|
bool suc = modbusMaster->initializeTtyChannel("/dev/ttyUSB0", 115200); |
||||
|
if (!suc) { |
||||
|
logger->error("modbusMaster initializeTtyChannel fail"); |
||||
|
} |
||||
|
|
||||
|
thread.reset(new Thread("input_device_state_monitor", [this]() { inputStateMonitorLoop(); })); |
||||
|
|
||||
|
idcard_read_thread.reset(new Thread("idcard_read", [this]() { |
||||
|
ThisThread thisThread; |
||||
|
while (!thisThread.getExitFlag()) { |
||||
|
try { |
||||
|
bool state; |
||||
|
string info; |
||||
|
|
||||
|
idcardread(state, info); |
||||
|
if (state) { |
||||
|
logger->info("idcard read info:{}", info); |
||||
|
onidcard(info); |
||||
|
} |
||||
|
|
||||
|
} catch (zexception& e) { |
||||
|
static tp_steady lastlogticket; |
||||
|
if (tu_steady().elapsedTimeS(lastlogticket) > 5) { |
||||
|
logger->error("idcard read fail:{}", e.what()); |
||||
|
lastlogticket = tu_steady().now(); |
||||
|
} |
||||
|
} |
||||
|
thisThread.sleepForMs(100); |
||||
|
} |
||||
|
})); |
||||
|
} |
||||
|
void DeviceIOService::relayControl(uint16_t off, bool value) { |
||||
|
/**
|
||||
|
* @brief |
||||
|
* 0(16Byte) | 继电器0 ->继电器15 掩码 |
||||
|
* 1(16Byte) | 继电器16->继电器31 掩码 |
||||
|
* 2(16Byte) | 继电器0 ->继电器15 继电器状态 |
||||
|
* 3(16Byte) | 继电器16->继电器31 继电器状态 |
||||
|
*/ |
||||
|
uint32_t mask = 1 << off; |
||||
|
uint32_t status = value ? mask : 0; |
||||
|
|
||||
|
uint16_t reg[4]; |
||||
|
MODBUS_SET_REG(reg[0], uint16_t(mask)); |
||||
|
MODBUS_SET_REG(reg[1], uint16_t(mask >> 16)); |
||||
|
MODBUS_SET_REG(reg[2], uint16_t(status)); |
||||
|
MODBUS_SET_REG(reg[3], uint16_t(status >> 16)); |
||||
|
|
||||
|
EXEC_MODBUS(modbusMaster->modbus10(ksubboarddeviceid, 0, 4, reg, kovertime)); |
||||
|
} |
||||
|
bool DeviceIOService::relayStateGet(uint16_t off) { |
||||
|
/**
|
||||
|
* @brief |
||||
|
* 0(16Byte) | 继电器0 ->继电器15 掩码 |
||||
|
* 1(16Byte) | 继电器16->继电器31 掩码 |
||||
|
* 2(16Byte) | 继电器0 ->继电器15 继电器状态 |
||||
|
* 3(16Byte) | 继电器16->继电器31 继电器状态 |
||||
|
*/ |
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, 2, 2, modbus03rx, kovertime)); |
||||
|
uint32_t regstate = uint32_t(modbus03rx.getReg(2)) | uint32_t(modbus03rx.getReg(3) << 16); |
||||
|
return (regstate & (1 << off)) != 0; |
||||
|
} |
||||
|
|
||||
|
uint16_t DeviceIOService::getReg(int index) { |
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, index, 1, modbus03rx, kovertime)); |
||||
|
return modbus03rx.getReg(index); |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* ==================================================路由器电源控制=================================================== * |
||||
|
***********************************************************************************************************************/ |
||||
|
bool DeviceIOService::routerGetPowerState() { return relayStateGet(0); } |
||||
|
void DeviceIOService::routerSetPowerState(bool routepower) { |
||||
|
logger->debug("routerSetPowerState {}", routepower); |
||||
|
relayControl(0, true); |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* ==================================================触控屏供电控制=================================================== * |
||||
|
***********************************************************************************************************************/ |
||||
|
bool DeviceIOService::touchScreenGetPowerState() { return relayStateGet(1); } |
||||
|
void DeviceIOService::touchScreenSetPowerState(bool touchpower) { |
||||
|
logger->debug("touchScreenSetPowerState {}", touchpower); |
||||
|
relayControl(1, touchpower); |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* ==================================================USB充电器供电=================================================== * |
||||
|
***********************************************************************************************************************/ |
||||
|
bool DeviceIOService::usbChargerGetPowerState() { return relayStateGet(2); } |
||||
|
void DeviceIOService::usbChargerSetPowerState(bool usbpower) { |
||||
|
logger->debug("usbChargerSetPowerState {}", usbpower); |
||||
|
relayControl(2, usbpower); |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* ==================================================摄像头供电=================================================== * |
||||
|
***********************************************************************************************************************/ |
||||
|
bool DeviceIOService::cameraGetPowerState() { return relayStateGet(3); } |
||||
|
void DeviceIOService::cameraSetPowerState(bool camerapower) { |
||||
|
logger->debug("cameraSetPowerState {}", camerapower); |
||||
|
relayControl(3, camerapower); |
||||
|
} |
||||
|
|
||||
|
/***********************************************************************************************************************
|
||||
|
* ==================================================照明控制=================================================== * |
||||
|
***********************************************************************************************************************/ |
||||
|
bool DeviceIOService::lightGetPowerState() { return relayStateGet(4); } |
||||
|
void DeviceIOService::lightSetPowerState(bool lightpower) { |
||||
|
logger->debug("lightSetPowerState {}", lightpower); |
||||
|
relayControl(4, lightpower); |
||||
|
} |
||||
|
|
||||
|
uint32_t DeviceIOService::getinputState() { |
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, 4, 2, modbus03rx, kovertime)); |
||||
|
uint32_t regstate = uint32_t(modbus03rx.getReg(4)) | uint32_t(modbus03rx.getReg(5) << 16); |
||||
|
return regstate; |
||||
|
} |
||||
|
|
||||
|
void DeviceIOService::inputStateMonitorLoop() { |
||||
|
ThisThread thisThread; |
||||
|
while (!thisThread.getExitFlag()) { |
||||
|
uint32_t regstate = 0; |
||||
|
try { |
||||
|
regstate = getinputState(); |
||||
|
for (size_t i = 0; i < 32; i++) { |
||||
|
bool state = (regstate & (1 << i)) != 0; |
||||
|
bool oldstate = (keystate & (1 << i)) != 0; |
||||
|
if (state != oldstate) { |
||||
|
logger->info("on {} state change, state={}", input_device_type2str(input_device_type_t(i)), state); |
||||
|
onInputStateChange((input_device_type_t)i, state); |
||||
|
} |
||||
|
} |
||||
|
} catch (const std::exception& e) { |
||||
|
/**
|
||||
|
* @brief 如果出现异常,则每隔5秒打印一次日志 |
||||
|
*/ |
||||
|
static tp_steady lastlogticket; |
||||
|
if (tu_steady().elapsedTimeS(lastlogticket) > 5) { |
||||
|
logger->error("inputStateMonitorLoop fail, {}", e.what()); |
||||
|
lastlogticket = tu_steady().now(); |
||||
|
} |
||||
|
} |
||||
|
thisThread.sleepForMs(50); |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
uint32_t DeviceIOService::getInterTemperature() { return getReg(16); } |
||||
|
|
||||
|
DeviceIOService::env_sensor_state_t DeviceIOService::getEnvSensorState() { |
||||
|
Modbus03Rx modbus03rx; |
||||
|
env_sensor_state_t env_sensor_state = {0}; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, 48, 11, modbus03rx, kovertime)); |
||||
|
/**
|
||||
|
48(16Byte) | 风速 |
||||
|
49(16Byte) | 风向 |
||||
|
50(16Byte) | temperature 实际湿度值=temperature/10 ℃ |
||||
|
51(16Byte) | humidity 实际湿度值=humidity/10 (0->100%) |
||||
|
52(16Byte) | 噪声 |
||||
|
53(16Byte) | pm2.5 ug/m³ |
||||
|
54(16Byte) | pm10 ug/m³ |
||||
|
55(16Byte) | co2 PPM |
||||
|
56(16Byte) | 大气压力 PPM |
||||
|
57(16Byte) | tvoc ppm |
||||
|
58(16Byte) | hcho mg/m3 |
||||
|
*/ |
||||
|
env_sensor_state.wind_speed = modbus03rx.getReg(48); |
||||
|
env_sensor_state.wind_direction = modbus03rx.getReg(49); |
||||
|
env_sensor_state.temperature = modbus03rx.getReg(50); |
||||
|
env_sensor_state.humidity = modbus03rx.getReg(51); |
||||
|
env_sensor_state.noise = modbus03rx.getReg(52); |
||||
|
env_sensor_state.pm2_5 = modbus03rx.getReg(53); |
||||
|
env_sensor_state.pm10 = modbus03rx.getReg(54); |
||||
|
env_sensor_state.co2 = modbus03rx.getReg(55); |
||||
|
env_sensor_state.atmospheric_pressure = modbus03rx.getReg(56); |
||||
|
env_sensor_state.tvoc = modbus03rx.getReg(57); |
||||
|
env_sensor_state.hcho = modbus03rx.getReg(58); |
||||
|
logger->debug( |
||||
|
"getEnvSensorState, " |
||||
|
"wind_speed={},wind_direction={},temperature={},humidity={},noise={},pm2_5={},pm10={},co2={},atmospheric_" |
||||
|
"pressure={},tvoc={},hcho={}", |
||||
|
env_sensor_state.wind_speed, env_sensor_state.wind_direction, env_sensor_state.temperature, |
||||
|
env_sensor_state.humidity, env_sensor_state.noise, env_sensor_state.pm2_5, env_sensor_state.pm10, |
||||
|
env_sensor_state.co2, env_sensor_state.atmospheric_pressure, env_sensor_state.tvoc, env_sensor_state.hcho); |
||||
|
return env_sensor_state; |
||||
|
} |
||||
|
|
||||
|
void DeviceIOService::fanGetState(int id, float& power, uint16_t& error) { |
||||
|
int startindex = 0; |
||||
|
if (id == 0) { |
||||
|
startindex = 128; |
||||
|
} else if (id == 1) { |
||||
|
startindex = 136; |
||||
|
} else { |
||||
|
power = 0; |
||||
|
error = 0; |
||||
|
logger->error("fanGetState fail, id={},id is illegal", id); |
||||
|
} |
||||
|
|
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, startindex, 2, modbus03rx, kovertime)); |
||||
|
power = modbus03rx.getReg(startindex); |
||||
|
error = modbus03rx.getReg(startindex + 1); |
||||
|
logger->debug("fanGetState, id={},power={},error={}", id, power, error); |
||||
|
return; |
||||
|
} |
||||
|
void DeviceIOService::fanSetState(int id, float power) { |
||||
|
logger->debug("fanSetState, id={},power={}", id, power); |
||||
|
int startindex = 0; |
||||
|
if (id == 0) { |
||||
|
startindex = 128; |
||||
|
} else if (id == 1) { |
||||
|
startindex = 136; |
||||
|
} else { |
||||
|
logger->error("fanGetState fail, id={},id is illegal", id); |
||||
|
return; |
||||
|
} |
||||
|
|
||||
|
uint16_t reg[1]; |
||||
|
MODBUS_SET_REG(reg[0], uint16_t(power)); |
||||
|
EXEC_MODBUS(modbusMaster->modbus10(ksubboarddeviceid, startindex, 1, reg, kovertime)); |
||||
|
return; |
||||
|
} |
||||
|
|
||||
|
void DeviceIOService::idcardread(bool& state, string& info) { |
||||
|
/**
|
||||
|
* 64->127 | 读卡器透传,03时读取消息,10写消息 |
||||
|
* 64(16Byte) | 是否有新卡信息 |
||||
|
* 65(16Byte) | 卡的内容 |
||||
|
* 65(16Byte) | |
||||
|
* ..(16Byte) | |
||||
|
* 127(16Byte) | |
||||
|
*/ |
||||
|
state = false; |
||||
|
info = ""; |
||||
|
int datalen = 0; |
||||
|
{ |
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, 64, 1, modbus03rx, kovertime)); |
||||
|
datalen = modbus03rx.getReg(64); |
||||
|
} |
||||
|
if (datalen == 0) { |
||||
|
logger->debug("idcardread, state={},info={}", state, info); |
||||
|
return; |
||||
|
} |
||||
|
|
||||
|
int readreg = datalen / 2 + datalen % 2 != 0 ? 1 : 0; |
||||
|
|
||||
|
{ |
||||
|
Modbus03Rx modbus03rx; |
||||
|
EXEC_MODBUS(modbusMaster->modbus03(ksubboarddeviceid, 65, readreg, modbus03rx, kovertime)); |
||||
|
info = StringUtil().bytesToString(modbus03rx.getRegBegin(), datalen); |
||||
|
} |
||||
|
state = true; |
||||
|
logger->debug("idcardread, state={},info={}", state, info); |
||||
|
return; |
||||
|
} |
Write
Preview
Loading…
Cancel
Save
Reference in new issue