zjk/H100PowerManger
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 1 Wiki Activity
Files
12f0dee86e634d1098691a6cf99fcb24d3d68933
H100PowerManger/src/pPowerManger/driver.cpp
T
zjk e455e2e9da 修复：编译告警（格式串不匹配、非 void 函数缺返回值、C++17 结构化绑定） 
- 修复 LOG_F 格式串与参数类型/数量不匹配（udpComm.h、uPlan_taskStart.h、httpserver.cpp、PowerManagerFsm.cpp、WaterBasedReady.cpp、LowerCommManager.cpp）
- httpserver.cpp 中 mg_connection::fd 为 void*，打印时强转为 int
- uExternComm_setOpCondition.h / uPower_sysState.h 补齐返回值，消除 -Wreturn-type
- driver.cpp 移除结构化绑定（C++17），保持 -std=c++11
- PowerManagerFsm.hpp 为 class Lifting 补充 react(DevCmdExt) 声明，消除死代码编译错误
2026-08-19 21:52:29 +08:00

1095 lines
48 KiB
C++
Raw Blame History

#include "driver.h"
Driver::Driver()
{
currentDriverTable.reset(new DriverTable());
nextDriverTable.reset(new DriverTable());
debug = false;
}
Driver::~Driver() = default;
void Driver::setDebug(bool debug)
{
this->debug = debug;
}
void Driver::setDeviceState(DriverTable &driverTable, DeviceId::Type deviceId, unsigned char s) {
switch(deviceId) {
case DeviceId::depth1: driverTable.depth1 = s; break;
case DeviceId::depth2: driverTable.depth2 = s; break;
case DeviceId::depth3: driverTable.depth3 = s; break;
case DeviceId::overDeep1: driverTable.overDeep1 = s; break;
case DeviceId::overDeep2: driverTable.overDeep2 = s; break;
case DeviceId::ctd1: driverTable.ctd1 = s; break;
case DeviceId::ctd2: driverTable.ctd2 = s; break;
case DeviceId::soundVeloc: driverTable.soundVeloc = s; break;
case DeviceId::commMast: driverTable.commMast = s; break;
case DeviceId::ins: driverTable.ins = s; break;
case DeviceId::ntp: driverTable.ntp = s; break;
case DeviceId::inputWaterSensor1: driverTable.inputWaterSensor1 = s; break;
case DeviceId::inputWaterSensor2: driverTable.inputWaterSensor2 = s; break;
case DeviceId::inputWaterSensor3: driverTable.inputWaterSensor3 = s; break;
case DeviceId::singleBeamSonar1: driverTable.singleBeamSonar1 = s; break;
case DeviceId::singleBeamSonar2: driverTable.singleBeamSonar2 = s; break;
case DeviceId::singleBeamSonar3: driverTable.singleBeamSonar3 = s; break;
case DeviceId::singleBeamSonar4: driverTable.singleBeamSonar4 = s; break;
case DeviceId::singleBeamSonar5: driverTable.singleBeamSonar5 = s; break;
case DeviceId::singleBeamSonar6: driverTable.singleBeamSonar6 = s; break;
case DeviceId::singleBeamSonar7: driverTable.singleBeamSonar7 = s; break;
case DeviceId::singleBeamSonar8: driverTable.singleBeamSonar8 = s; break;
case DeviceId::forwardSonar: driverTable.forwardSonar = s; break;
case DeviceId::DVL: driverTable.DVL = s; break;
case DeviceId::lowFreqSonar: driverTable.lowFreqSonar = s; break;
case DeviceId::USBL: driverTable.USBL = s; break;
case DeviceId::bowWaterInet1: driverTable.bowWaterInet1 = s; break;
case DeviceId::bowWaterInet2: driverTable.bowWaterInet2 = s; break;
case DeviceId::bowWaterInet3: driverTable.bowWaterInet3 = s; break;
case DeviceId::bowWaterInet4: driverTable.bowWaterInet4 = s; break;
case DeviceId::bowWaterInet5: driverTable.bowWaterInet5 = s; break;
case DeviceId::bowWaterInet6: driverTable.bowWaterInet6 = s; break;
case DeviceId::bowWaterInet7: driverTable.bowWaterInet7 = s; break;
case DeviceId::bowWaterInet8: driverTable.bowWaterInet8 = s; break;
case DeviceId::bowRudderDeploy: driverTable.bowRudderDeploy = s; break;
case DeviceId::bowRudderServo1: driverTable.bowRudderServo1 = s; break;
case DeviceId::bowRudderServo2: driverTable.bowRudderServo2 = s; break;
case DeviceId::bowCover1: driverTable.bowCover1 = s; break;
case DeviceId::bowCover2: driverTable.bowCover2 = s; break;
case DeviceId::bowCover3: driverTable.bowCover3 = s; break;
case DeviceId::bowCover4: driverTable.bowCover4 = s; break;
case DeviceId::bowCover5: driverTable.bowCover5 = s; break;
case DeviceId::bowCover6: driverTable.bowCover6 = s; break;
case DeviceId::waterInject: driverTable.waterInject = s; break;
case DeviceId::mastLiftingServo: driverTable.mastLiftingServo = s; break;
case DeviceId::buoyancyAdjust1: driverTable.buoyancyAdjust1 = s; break;
case DeviceId::buoyancyAdjust2: driverTable.buoyancyAdjust2 = s; break;
case DeviceId::buoyancyAdjust3: driverTable.buoyancyAdjust3 = s; break;
case DeviceId::buoyancyAdjust4: driverTable.buoyancyAdjust4 = s; break;
case DeviceId::buoyancyAdjust5: driverTable.buoyancyAdjust5 = s; break;
case DeviceId::sternRudderServo1: driverTable.sternRudderServo1 = s; break;
case DeviceId::sternRudderServo2: driverTable.sternRudderServo2 = s; break;
case DeviceId::sternRudderServo3: driverTable.sternRudderServo3 = s; break;
case DeviceId::sternRudderServo4: driverTable.sternRudderServo4 = s; break;
case DeviceId::thruster: driverTable.thruster = s; break;
case DeviceId::bowThrow: driverTable.bowThrow = s; break;
case DeviceId::sternThrow: driverTable.sternThrow = s; break;
case DeviceId::photoSensor: driverTable.photoSensor = s; break;
case DeviceId::electSensor: driverTable.electSensor = s; break;
case DeviceId::launchControler: driverTable.launchControler = s; break;
case DeviceId::sideSonar: driverTable.sideSonar = s; break;
case DeviceId::buoyage: driverTable.buoyage = s; break;
default: break;
}
}
unsigned char Driver::getDeviceState(const DriverTable &driverTable, DeviceId::Type deviceId) {
switch(deviceId) {
case DeviceId::depth1: return driverTable.depth1;
case DeviceId::depth2: return driverTable.depth2;
case DeviceId::depth3: return driverTable.depth3;
case DeviceId::overDeep1: return driverTable.overDeep1;
case DeviceId::overDeep2: return driverTable.overDeep2;
case DeviceId::ctd1: return driverTable.ctd1;
case DeviceId::ctd2: return driverTable.ctd2;
case DeviceId::soundVeloc: return driverTable.soundVeloc;
case DeviceId::commMast: return driverTable.commMast;
case DeviceId::ins: return driverTable.ins;
case DeviceId::ntp: return driverTable.ntp;
case DeviceId::inputWaterSensor1: return driverTable.inputWaterSensor1;
case DeviceId::inputWaterSensor2: return driverTable.inputWaterSensor2;
case DeviceId::inputWaterSensor3: return driverTable.inputWaterSensor3;
case DeviceId::singleBeamSonar1: return driverTable.singleBeamSonar1;
case DeviceId::singleBeamSonar2: return driverTable.singleBeamSonar2;
case DeviceId::singleBeamSonar3: return driverTable.singleBeamSonar3;
case DeviceId::singleBeamSonar4: return driverTable.singleBeamSonar4;
case DeviceId::singleBeamSonar5: return driverTable.singleBeamSonar5;
case DeviceId::singleBeamSonar6: return driverTable.singleBeamSonar6;
case DeviceId::singleBeamSonar7: return driverTable.singleBeamSonar7;
case DeviceId::singleBeamSonar8: return driverTable.singleBeamSonar8;
case DeviceId::forwardSonar: return driverTable.forwardSonar;
case DeviceId::DVL: return driverTable.DVL;
case DeviceId::lowFreqSonar: return driverTable.lowFreqSonar;
case DeviceId::USBL: return driverTable.USBL;
case DeviceId::bowWaterInet1: return driverTable.bowWaterInet1;
case DeviceId::bowWaterInet2: return driverTable.bowWaterInet2;
case DeviceId::bowWaterInet3: return driverTable.bowWaterInet3;
case DeviceId::bowWaterInet4: return driverTable.bowWaterInet4;
case DeviceId::bowWaterInet5: return driverTable.bowWaterInet5;
case DeviceId::bowWaterInet6: return driverTable.bowWaterInet6;
case DeviceId::bowWaterInet7: return driverTable.bowWaterInet7;
case DeviceId::bowWaterInet8: return driverTable.bowWaterInet8;
case DeviceId::bowRudderDeploy: return driverTable.bowRudderDeploy;
case DeviceId::bowRudderServo1: return driverTable.bowRudderServo1;
case DeviceId::bowRudderServo2: return driverTable.bowRudderServo2;
case DeviceId::bowCover1: return driverTable.bowCover1;
case DeviceId::bowCover2: return driverTable.bowCover2;
case DeviceId::bowCover3: return driverTable.bowCover3;
case DeviceId::bowCover4: return driverTable.bowCover4;
case DeviceId::bowCover5: return driverTable.bowCover5;
case DeviceId::bowCover6: return driverTable.bowCover6;
case DeviceId::waterInject: return driverTable.waterInject;
case DeviceId::mastLiftingServo: return driverTable.mastLiftingServo;
case DeviceId::buoyancyAdjust1: return driverTable.buoyancyAdjust1;
case DeviceId::buoyancyAdjust2: return driverTable.buoyancyAdjust2;
case DeviceId::buoyancyAdjust3: return driverTable.buoyancyAdjust3;
case DeviceId::buoyancyAdjust4: return driverTable.buoyancyAdjust4;
case DeviceId::buoyancyAdjust5: return driverTable.buoyancyAdjust5;
case DeviceId::sternRudderServo1: return driverTable.sternRudderServo1;
case DeviceId::sternRudderServo2: return driverTable.sternRudderServo2;
case DeviceId::sternRudderServo3: return driverTable.sternRudderServo3;
case DeviceId::sternRudderServo4: return driverTable.sternRudderServo4;
case DeviceId::thruster: return driverTable.thruster;
case DeviceId::bowThrow: return driverTable.bowThrow;
case DeviceId::sternThrow: return driverTable.sternThrow;
case DeviceId::photoSensor: return driverTable.photoSensor;
case DeviceId::electSensor: return driverTable.electSensor;
case DeviceId::launchControler: return driverTable.launchControler;
case DeviceId::sideSonar: return driverTable.sideSonar;
case DeviceId::buoyage: return driverTable.buoyage;
default: return 0; // 默认返回0表示无效状态
}
}
void Driver::getSTANDBYTable(DriverTable* driverTable)
{
//打开所有传感器
driverTable->depth1 = 1;
driverTable->depth2 = 1;
driverTable->depth3 = 1;
driverTable->overDeep1 = 1;
driverTable->overDeep2 = 1;
driverTable->ctd1 = 1;
driverTable->ctd2 = 1;
driverTable->soundVeloc = 1;
driverTable->commMast = 1;
driverTable->ins = 1;
driverTable->ntp = 1;
driverTable->inputWaterSensor1 = 1;
driverTable->inputWaterSensor2 = 1;
driverTable->inputWaterSensor3 = 1;
//关闭所有负载
driverTable->photoSensor = 0;
driverTable->electSensor = 0;
driverTable->launchControler = 0;
driverTable->sideSonar = 0;
driverTable->buoyage = 0;
//关闭所有水声设备
driverTable->singleBeamSonar1 = 0;
driverTable->singleBeamSonar2 = 0;
driverTable->singleBeamSonar3 = 0;
driverTable->singleBeamSonar4 = 0;
driverTable->singleBeamSonar5 = 0;
driverTable->singleBeamSonar6 = 0;
driverTable->singleBeamSonar7 = 0;
driverTable->singleBeamSonar8 = 0;
driverTable->DVL = 0;
driverTable->forwardSonar = 0;
driverTable->lowFreqSonar = 0;
driverTable->USBL = 0;
//关闭所有执行机构
driverTable->bowCover1 = 0;
driverTable->bowCover2 = 0;
driverTable->bowCover3 = 0;
driverTable->bowCover4 = 0;
driverTable->bowCover5 = 0;
driverTable->bowCover6 = 0;
driverTable->bowRudderDeploy = 0;
driverTable->bowRudderServo1 = 0;
driverTable->bowRudderServo2 = 0;
driverTable->bowWaterInet1 = 0;
driverTable->bowWaterInet2 = 0;
driverTable->bowWaterInet3 = 0;
driverTable->bowWaterInet4 = 0;
driverTable->bowWaterInet5 = 0;
driverTable->bowWaterInet6 = 0;
driverTable->bowWaterInet7 = 0;
driverTable->bowWaterInet8 = 0;
driverTable->waterInject = 0;
driverTable->mastLiftingServo = 0;
driverTable->buoyancyAdjust1 = 0;
driverTable->buoyancyAdjust2 = 0;
driverTable->buoyancyAdjust3 = 0;
driverTable->buoyancyAdjust4 = 0;
driverTable->buoyancyAdjust5 = 0;
driverTable->sternRudderServo1 = 0;
driverTable->sternRudderServo2 = 0;
driverTable->sternRudderServo3 = 0;
driverTable->sternRudderServo4 = 0;
driverTable->thruster = 0;
driverTable->bowThrow = 0;
driverTable->sternThrow = 0;
}
void Driver::getSHORE_BASED_READYable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = 1;
driverTable->depth2 = 1;
driverTable->depth3 = 1;
driverTable->overDeep1 = 1;
driverTable->overDeep2 = 1;
driverTable->ctd1 = 1;
driverTable->ctd2 = 1;
driverTable->soundVeloc = 1;
driverTable->commMast = 1;
driverTable->ins = 1;
driverTable->ntp = 1;
driverTable->inputWaterSensor1 = 1;
driverTable->inputWaterSensor2 = 1;
driverTable->inputWaterSensor3 = 1;
// 允许启动负载
// 关闭xcz
driverTable->photoSensor = 0;
driverTable->electSensor = 0;
driverTable->launchControler = 0;
driverTable->sideSonar = 0;
driverTable->buoyage = 0;
// 关闭所有水声设备
driverTable->singleBeamSonar1 = 0;
driverTable->singleBeamSonar2 = 0;
driverTable->singleBeamSonar3 = 0;
driverTable->singleBeamSonar4 = 0;
driverTable->singleBeamSonar5 = 0;
driverTable->singleBeamSonar6 = 0;
driverTable->singleBeamSonar7 = 0;
driverTable->singleBeamSonar8 = 0;
driverTable->DVL = 0;
driverTable->forwardSonar = 0;
driverTable->lowFreqSonar = 0;
driverTable->USBL = 0;
// 打开必要的执行机构
driverTable->bowCover1 = 1;
driverTable->bowCover2 = 1;
driverTable->bowCover3 = 1;
driverTable->bowCover4 = 1;
driverTable->bowCover5 = 1;
driverTable->bowCover6 = 1;
driverTable->bowRudderDeploy = 1;
driverTable->bowRudderServo1 = 1;
driverTable->bowRudderServo2 = 1;
driverTable->bowWaterInet1 = 1;
driverTable->bowWaterInet2 = 1;
driverTable->bowWaterInet3 = 1;
driverTable->bowWaterInet4 = 1;
driverTable->bowWaterInet5 = 1;
driverTable->bowWaterInet6 = 1;
driverTable->bowWaterInet7 = 1;
driverTable->bowWaterInet8 = 1;
driverTable->waterInject = 1;
driverTable->mastLiftingServo = 1;
driverTable->buoyancyAdjust1 = 1;
driverTable->buoyancyAdjust2 = 1;
driverTable->buoyancyAdjust3 = 1;
driverTable->buoyancyAdjust4 = 1;
driverTable->buoyancyAdjust5 = 1;
driverTable->sternRudderServo1 = 1;
driverTable->sternRudderServo2 = 1;
driverTable->sternRudderServo3 = 1;
driverTable->sternRudderServo4 = 1;
driverTable->thruster = 1;
driverTable->bowThrow = 1;
driverTable->sternThrow = 1;
}
void Driver::getWATER_BASED_READYable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = 1;
driverTable->depth2 = 1;
driverTable->depth3 = 1;
driverTable->overDeep1 = 1;
driverTable->overDeep2 = 1;
driverTable->ctd1 = 1;
driverTable->ctd2 = 1;
driverTable->soundVeloc = 1;
driverTable->commMast = 1;
driverTable->ins = 1;
driverTable->ntp = 1;
driverTable->inputWaterSensor1 = 1;
driverTable->inputWaterSensor2 = 1;
driverTable->inputWaterSensor3 = 1;
// 允许启动负载
driverTable->photoSensor = 0;
driverTable->electSensor = 0;
driverTable->launchControler = 0;
driverTable->sideSonar = 0;
driverTable->buoyage = 0;
// 所有水声设备待机
driverTable->singleBeamSonar1 = 0;
driverTable->singleBeamSonar2 = 0;
driverTable->singleBeamSonar3 = 0;
driverTable->singleBeamSonar4 = 0;
driverTable->singleBeamSonar5 = 0;
driverTable->singleBeamSonar6 = 0;
driverTable->singleBeamSonar7 = 0;
driverTable->singleBeamSonar8 = 0;
driverTable->DVL = 0;
driverTable->forwardSonar = 0;
driverTable->lowFreqSonar = 0;
driverTable->USBL = 0;
// 打开必要的执行机构
driverTable->bowCover1 = 1;
driverTable->bowCover2 = 1;
driverTable->bowCover3 = 1;
driverTable->bowCover4 = 1;
driverTable->bowCover5 = 1;
driverTable->bowCover6 = 1;
driverTable->bowRudderDeploy = 1;
driverTable->bowRudderServo1 = 1;
driverTable->bowRudderServo2 = 1;
driverTable->bowWaterInet1 = 1;
driverTable->bowWaterInet2 = 1;
driverTable->bowWaterInet3 = 1;
driverTable->bowWaterInet4 = 1;
driverTable->bowWaterInet5 = 1;
driverTable->bowWaterInet6 = 1;
driverTable->bowWaterInet7 = 1;
driverTable->bowWaterInet8 = 1;
driverTable->waterInject = 1;
driverTable->mastLiftingServo = 1;
driverTable->buoyancyAdjust1 = 1;
driverTable->buoyancyAdjust2 = 1;
driverTable->buoyancyAdjust3 = 1;
driverTable->buoyancyAdjust4 = 1;
driverTable->buoyancyAdjust5 = 1;
driverTable->sternRudderServo1 = 1;
driverTable->sternRudderServo2 = 1;
driverTable->sternRudderServo3 = 1;
driverTable->sternRudderServo4 = 1;
driverTable->thruster = 1;
driverTable->bowThrow = 1;
driverTable->sternThrow = 1;
}
void Driver::getCRUISE_MODEable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = 1;
driverTable->depth2 = 1;
driverTable->depth3 = 1;
driverTable->overDeep1 = 1;
driverTable->overDeep2 = 1;
driverTable->ctd1 = 1;
driverTable->ctd2 = 1;
driverTable->soundVeloc = 1;
driverTable->commMast = 1;
driverTable->ins = 1;
driverTable->ntp = 1;
driverTable->inputWaterSensor1 = 1;
driverTable->inputWaterSensor2 = 1;
driverTable->inputWaterSensor3 = 1;
// 所有负载设备关机
driverTable->photoSensor = 0;
driverTable->electSensor = 0;
driverTable->launchControler = 0;
driverTable->sideSonar = 0;
driverTable->buoyage = 0;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = 0;
driverTable->bowCover2 = 0;
driverTable->bowCover3 = 0;
driverTable->bowCover4 = 0;
driverTable->bowCover5 = 0;
driverTable->bowCover6 = 0;
driverTable->bowRudderDeploy = 1;
driverTable->bowRudderServo1 = 1;
driverTable->bowRudderServo2 = 1;
driverTable->bowWaterInet1 = 0;
driverTable->bowWaterInet2 = 0;
driverTable->bowWaterInet3 = 0;
driverTable->bowWaterInet4 = 0;
driverTable->bowWaterInet5 = 0;
driverTable->bowWaterInet6 = 0;
driverTable->bowWaterInet7 = 0;
driverTable->bowWaterInet8 = 0;
driverTable->waterInject = 0;
driverTable->mastLiftingServo = 1;
driverTable->buoyancyAdjust1 = 1;
driverTable->buoyancyAdjust2 = 1;
driverTable->buoyancyAdjust3 = 1;
driverTable->buoyancyAdjust4 = 1;
driverTable->buoyancyAdjust5 = 1;
driverTable->sternRudderServo1 = 1;
driverTable->sternRudderServo2 = 1;
driverTable->sternRudderServo3 = 1;
driverTable->sternRudderServo4 = 1;
driverTable->thruster = 1;
driverTable->bowThrow = 1;
driverTable->sternThrow = 1;
}
void Driver::getHIGH_SPEED_MODEable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_POWER_OFF;
driverTable->electSensor = DRIVER_POWER_OFF;
driverTable->launchControler = DRIVER_POWER_OFF;
driverTable->sideSonar = DRIVER_POWER_OFF;
driverTable->buoyage = DRIVER_POWER_OFF;
// 打开必要的执行机构，只打开操纵机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_POWER_OFF;
driverTable->bowCover2 = DRIVER_POWER_OFF;
driverTable->bowCover3 = DRIVER_POWER_OFF;
driverTable->bowCover4 = DRIVER_POWER_OFF;
driverTable->bowCover5 = DRIVER_POWER_OFF;
driverTable->bowCover6 = DRIVER_POWER_OFF;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_POWER_OFF;
driverTable->bowWaterInet2 = DRIVER_POWER_OFF;
driverTable->bowWaterInet3 = DRIVER_POWER_OFF;
driverTable->bowWaterInet4 = DRIVER_POWER_OFF;
driverTable->bowWaterInet5 = DRIVER_POWER_OFF;
driverTable->bowWaterInet6 = DRIVER_POWER_OFF;
driverTable->bowWaterInet7 = DRIVER_POWER_OFF;
driverTable->bowWaterInet8 = DRIVER_POWER_OFF;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust1 = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust2 = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust3 = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust4 = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust5 = DRIVER_POWER_OFF;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
// 上浮下潜与巡航模式一致
void Driver::getASCEND_DESCENDable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_POWER_OFF;
driverTable->electSensor = DRIVER_POWER_OFF;
driverTable->launchControler = DRIVER_POWER_OFF;
driverTable->sideSonar = DRIVER_POWER_OFF;
driverTable->buoyage = DRIVER_POWER_OFF;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_POWER_OFF;
driverTable->bowCover2 = DRIVER_POWER_OFF;
driverTable->bowCover3 = DRIVER_POWER_OFF;
driverTable->bowCover4 = DRIVER_POWER_OFF;
driverTable->bowCover5 = DRIVER_POWER_OFF;
driverTable->bowCover6 = DRIVER_POWER_OFF;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_POWER_OFF;
driverTable->bowWaterInet2 = DRIVER_POWER_OFF;
driverTable->bowWaterInet3 = DRIVER_POWER_OFF;
driverTable->bowWaterInet4 = DRIVER_POWER_OFF;
driverTable->bowWaterInet5 = DRIVER_POWER_OFF;
driverTable->bowWaterInet6 = DRIVER_POWER_OFF;
driverTable->bowWaterInet7 = DRIVER_POWER_OFF;
driverTable->bowWaterInet8 = DRIVER_POWER_OFF;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust1 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust2 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust3 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust4 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust5 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
// 浮标调整与巡航模式一致
void Driver::getBUOYANCY_ADJUSTable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_POWER_OFF;
driverTable->electSensor = DRIVER_POWER_OFF;
driverTable->launchControler = DRIVER_POWER_OFF;
driverTable->sideSonar = DRIVER_POWER_OFF;
driverTable->buoyage = DRIVER_POWER_OFF;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_POWER_OFF;
driverTable->bowCover2 = DRIVER_POWER_OFF;
driverTable->bowCover3 = DRIVER_POWER_OFF;
driverTable->bowCover4 = DRIVER_POWER_OFF;
driverTable->bowCover5 = DRIVER_POWER_OFF;
driverTable->bowCover6 = DRIVER_POWER_OFF;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_POWER_OFF;
driverTable->bowWaterInet2 = DRIVER_POWER_OFF;
driverTable->bowWaterInet3 = DRIVER_POWER_OFF;
driverTable->bowWaterInet4 = DRIVER_POWER_OFF;
driverTable->bowWaterInet5 = DRIVER_POWER_OFF;
driverTable->bowWaterInet6 = DRIVER_POWER_OFF;
driverTable->bowWaterInet7 = DRIVER_POWER_OFF;
driverTable->bowWaterInet8 = DRIVER_POWER_OFF;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust1 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust2 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust3 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust4 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust5 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
// 水下侦查
void Driver::getUNDERWATER_RECONable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_POWER_OFF;
driverTable->electSensor = DRIVER_POWER_OFF;
driverTable->launchControler = DRIVER_POWER_OFF;
driverTable->sideSonar = DRIVER_STANDBY;
driverTable->buoyage = DRIVER_POWER_OFF;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_POWER_OFF;
driverTable->bowCover2 = DRIVER_POWER_OFF;
driverTable->bowCover3 = DRIVER_POWER_OFF;
driverTable->bowCover4 = DRIVER_POWER_OFF;
driverTable->bowCover5 = DRIVER_POWER_OFF;
driverTable->bowCover6 = DRIVER_POWER_OFF;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_POWER_OFF;
driverTable->bowWaterInet2 = DRIVER_POWER_OFF;
driverTable->bowWaterInet3 = DRIVER_POWER_OFF;
driverTable->bowWaterInet4 = DRIVER_POWER_OFF;
driverTable->bowWaterInet5 = DRIVER_POWER_OFF;
driverTable->bowWaterInet6 = DRIVER_POWER_OFF;
driverTable->bowWaterInet7 = DRIVER_POWER_OFF;
driverTable->bowWaterInet8 = DRIVER_POWER_OFF;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_POWER_OFF;
driverTable->buoyancyAdjust1 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust2 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust3 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust4 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust5 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
// 水面探测
void Driver::getSURFACE_RECONable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_STANDBY;
driverTable->electSensor = DRIVER_STANDBY;
driverTable->launchControler = DRIVER_POWER_OFF;
driverTable->sideSonar = DRIVER_POWER_OFF;
driverTable->buoyage = DRIVER_POWER_OFF;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_POWER_OFF;
driverTable->bowCover2 = DRIVER_POWER_OFF;
driverTable->bowCover3 = DRIVER_POWER_OFF;
driverTable->bowCover4 = DRIVER_POWER_OFF;
driverTable->bowCover5 = DRIVER_POWER_OFF;
driverTable->bowCover6 = DRIVER_POWER_OFF;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_POWER_OFF;
driverTable->bowWaterInet2 = DRIVER_POWER_OFF;
driverTable->bowWaterInet3 = DRIVER_POWER_OFF;
driverTable->bowWaterInet4 = DRIVER_POWER_OFF;
driverTable->bowWaterInet5 = DRIVER_POWER_OFF;
driverTable->bowWaterInet6 = DRIVER_POWER_OFF;
driverTable->bowWaterInet7 = DRIVER_POWER_OFF;
driverTable->bowWaterInet8 = DRIVER_POWER_OFF;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust1 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust2 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust3 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust4 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust5 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
void Driver::getDJ_MODEable(DriverTable* driverTable)
{
// 打开所有传感器
driverTable->depth1 = DRIVER_FULL_POWER_ON;
driverTable->depth2 = DRIVER_FULL_POWER_ON;
driverTable->depth3 = DRIVER_FULL_POWER_ON;
driverTable->overDeep1 = DRIVER_FULL_POWER_ON;
driverTable->overDeep2 = DRIVER_FULL_POWER_ON;
driverTable->ctd1 = DRIVER_FULL_POWER_ON;
driverTable->ctd2 = DRIVER_FULL_POWER_ON;
driverTable->soundVeloc = DRIVER_FULL_POWER_ON;
driverTable->commMast = DRIVER_FULL_POWER_ON;
driverTable->ins = DRIVER_FULL_POWER_ON;
driverTable->ntp = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor1 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor2 = DRIVER_FULL_POWER_ON;
driverTable->inputWaterSensor3 = DRIVER_FULL_POWER_ON;
// 所有负载设备关机
driverTable->photoSensor = DRIVER_POWER_OFF;
driverTable->electSensor = DRIVER_POWER_OFF;
driverTable->launchControler = DRIVER_FULL_POWER_ON;
driverTable->sideSonar = DRIVER_POWER_OFF;
driverTable->buoyage = DRIVER_STANDBY;
// 打开必要的执行机构
// 关闭非必要的执行机构
driverTable->bowCover1 = DRIVER_FULL_POWER_ON;
driverTable->bowCover2 = DRIVER_FULL_POWER_ON;
driverTable->bowCover3 = DRIVER_FULL_POWER_ON;
driverTable->bowCover4 = DRIVER_FULL_POWER_ON;
driverTable->bowCover5 = DRIVER_FULL_POWER_ON;
driverTable->bowCover6 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderDeploy = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->bowRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet1 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet2 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet3 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet4 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet5 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet6 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet7 = DRIVER_FULL_POWER_ON;
driverTable->bowWaterInet8 = DRIVER_FULL_POWER_ON;
driverTable->waterInject = DRIVER_POWER_OFF;
driverTable->mastLiftingServo = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust1 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust2 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust3 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust4 = DRIVER_FULL_POWER_ON;
driverTable->buoyancyAdjust5 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo1 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo2 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo3 = DRIVER_FULL_POWER_ON;
driverTable->sternRudderServo4 = DRIVER_FULL_POWER_ON;
driverTable->thruster = DRIVER_FULL_POWER_ON;
driverTable->bowThrow = DRIVER_FULL_POWER_ON;
driverTable->sternThrow = DRIVER_FULL_POWER_ON;
}
std::string Driver::saveDriverTableToJson(const DriverTable* driverTable)
{
Json::Value root;
// 添加所有成员到json
root["depth1_uint8"] = driverTable->depth1;
root["depth2_uint8"] = driverTable->depth2;
root["depth3_uint8"] = driverTable->depth3;
root["overDeep1_uint8"] = driverTable->overDeep1;
root["overDeep2_uint8"] = driverTable->overDeep2;
root["ctd1_uint8"] = driverTable->ctd1;
root["ctd2_uint8"] = driverTable->ctd2;
root["soundVeloc_uint8"] = driverTable->soundVeloc;
root["commDev_uint8"] = driverTable->commMast;
root["ins_uint8"] = driverTable->ins;
root["ntp_uint8"] = driverTable->ntp;
root["inputWaterSensor1_uint8"] = driverTable->inputWaterSensor1;
root["inputWaterSensor2_uint8"] = driverTable->inputWaterSensor2;
root["inputWaterSensor3_uint8"] = driverTable->inputWaterSensor3;
root["singleBeamSonar1_uint8"] = driverTable->singleBeamSonar1;
root["singleBeamSonar2_uint8"] = driverTable->singleBeamSonar2;
root["singleBeamSonar3_uint8"] = driverTable->singleBeamSonar3;
root["singleBeamSonar4_uint8"] = driverTable->singleBeamSonar4;
root["singleBeamSonar5_uint8"] = driverTable->singleBeamSonar5;
root["singleBeamSonar6_uint8"] = driverTable->singleBeamSonar6;
root["singleBeamSonar7_uint8"] = driverTable->singleBeamSonar7;
root["singleBeamSonar8_uint8"] = driverTable->singleBeamSonar8;
root["forwardSonar_uint8"] = driverTable->forwardSonar;
root["DVL_uint8"] = driverTable->DVL;
root["lowFreqSonar_uint8"] = driverTable->lowFreqSonar;
root["USBL_uint8"] = driverTable->USBL;
root["bowCover1_uint8"] = driverTable->bowCover1;
root["bowCover2_uint8"] = driverTable->bowCover2;
root["bowCover3_uint8"] = driverTable->bowCover3;
root["bowCover4_uint8"] = driverTable->bowCover4;
root["bowCover5_uint8"] = driverTable->bowCover5;
root["bowCover6_uint8"] = driverTable->bowCover6;
root["bowRudderDeploy_uint8"] = driverTable->bowRudderDeploy;
root["bowRudderServo1_uint8"] = driverTable->bowRudderServo1;
root["bowRudderServo2_uint8"] = driverTable->bowRudderServo2;
root["bowWaterInet1_uint8"] = driverTable->bowWaterInet1;
root["bowWaterInet2_uint8"] = driverTable->bowWaterInet2;
root["bowWaterInet3_uint8"] = driverTable->bowWaterInet3;
root["bowWaterInet4_uint8"] = driverTable->bowWaterInet4;
root["bowWaterInet5_uint8"] = driverTable->bowWaterInet5;
root["bowWaterInet6_uint8"] = driverTable->bowWaterInet6;
root["bowWaterInet7_uint8"] = driverTable->bowWaterInet7;
root["bowWaterInet8_uint8"] = driverTable->bowWaterInet8;
root["waterInject_uint8"] = driverTable->waterInject;
root["mastLiftingServo_uint8"] = driverTable->mastLiftingServo;
root["buoyancyAdjust1_uint8"] = driverTable->buoyancyAdjust1;
root["buoyancyAdjust2_uint8"] = driverTable->buoyancyAdjust2;
root["buoyancyAdjust3_uint8"] = driverTable->buoyancyAdjust3;
root["buoyancyAdjust4_uint8"] = driverTable->buoyancyAdjust4;
root["buoyancyAdjust5_uint8"] = driverTable->buoyancyAdjust5;
root["sternRudderServo1_uint8"] = driverTable->sternRudderServo1;
root["sternRudderServo2_uint8"] = driverTable->sternRudderServo2;
root["sternRudderServo3_uint8"] = driverTable->sternRudderServo3;
root["sternRudderServo4_uint8"] = driverTable->sternRudderServo4;
root["thruster_uint8"] = driverTable->thruster;
root["bowThrow_uint8"] = driverTable->bowThrow;
root["sternThrow_uint8"] = driverTable->sternThrow;
root["photoSensor_uint8"] = driverTable->photoSensor;
root["electSensor_uint8"] = driverTable->electSensor;
root["launchControler_uint8"] = driverTable->launchControler;
root["sideSonar_uint8"] = driverTable->sideSonar;
root["buoyage_uint8"] = driverTable->buoyage;
return root.toStyledString();
}
std::string Driver::getDriverTableJson()
{
return saveDriverTableToJson(currentDriverTable.get());
}
std::string Driver::getSubDisCmdJson(const DriverTable* driverTable)
{
return saveDriverTableToJson(currentDriverTable.get());
}
std::string Driver::getDriveStateJson(const DriverTable* driverTable)
{
return saveDriverTableToJson(currentDriverTable.get());
}
int Driver::SafeReadUInt(const Json::Value& root, const std::string& key, unsigned char& value) {
if (!root.isMember(key)) {
// std::cerr << "错误: 缺少字段 " << key << std::endl;
return -1; // 返回-1表示缺少字段
}
if (!root[key].isUInt()) {
std::cerr << "错误: 字段 " << key << " 数据类型不正确，应为无符号整数" << std::endl;
return -2; // 返回-2表示数据类型错误
}
value = root[key].asUInt();
return 0; // 成功读取
}
vector<DriverCommand> Driver::loadDriverIdFromJson(const std::string &strJson) {
Json::CharReaderBuilder builder;
Json::Value root;
std::string errs;
vector<DriverCommand> driverCmd;
// 解析JSON字符串
std::istringstream s(strJson);
if (!Json::parseFromStream(builder, s, &root, &errs)) {
std::cerr << "JSON解析失败: " << errs << std::endl;
return driverCmd;
}
// 设备字段名到ID的映射
const std::map<std::string, int> fieldToId = {
{"depth1_uint8", 18}, {"depth2_uint8", 19}, {"depth3_uint8", 20},
{"overDeep1_uint8", 21}, {"overDeep2_uint8", 22},
{"ctd1_uint8", 23}, {"ctd2_uint8", 24}, {"soundVeloc_uint8", 25},
{"commDev_uint8", 40}, {"ins_uint8", 57}, {"ntp_uint8", 58},
{"inputWaterSensor1_uint8", 59}, {"inputWaterSensor2_uint8", 60}, {"inputWaterSensor3_uint8", 61},
{"singleBeamSonar1_uint8", 0}, {"singleBeamSonar2_uint8", 1}, {"singleBeamSonar3_uint8", 2},
{"singleBeamSonar4_uint8", 3}, {"singleBeamSonar5_uint8", 4}, {"singleBeamSonar6_uint8", 5},
{"singleBeamSonar7_uint8", 6}, {"singleBeamSonar8_uint8", 7}, {"forwardSonar_uint8", 8},
{"DVL_uint8", 43}, {"lowFreqSonar_uint8", 36}, {"USBL_uint8", 42},
{"bowCover1_uint8", 9}, {"bowCover2_uint8", 10}, {"bowCover3_uint8", 11},
{"bowCover4_uint8", 12}, {"bowCover5_uint8", 13}, {"bowCover6_uint8", 14},
{"bowRudderDeploy_uint8", 15}, {"bowRudderServo1_uint8", 16}, {"bowRudderServo2_uint8", 17},
{"bowWaterInet1_uint8", 27}, {"bowWaterInet2_uint8", 28}, {"bowWaterInet3_uint8", 29},
{"bowWaterInet4_uint8", 30}, {"bowWaterInet5_uint8", 31}, {"bowWaterInet6_uint8", 32},
{"bowWaterInet7_uint8", 33}, {"bowWaterInet8_uint8", 34}, {"waterInject_uint8", 26},
{"mastLiftingServo_uint8_uint8", 41}, {"buoyancyAdjust1_uint8", 44}, {"buoyancyAdjust2_uint8", 45},
{"buoyancyAdjust3_uint8", 46}, {"buoyancyAdjust4_uint8", 47}, {"buoyancyAdjust5_uint8", 48},
{"sternRudderServo1_uint8", 49}, {"sternRudderServo2_uint8", 50}, {"sternRudderServo3_uint8", 51},
{"sternRudderServo4_uint8", 52}, {"thruster_uint8", 53}, {"bowThrow_uint8", 54},
{"sternThrow_uint8", 55}, {"photoSensor_uint8", 38}, {"electSensor_uint8", 39},
{"launchControler_uint8", 37}, {"sideSonar_uint8", 35}, {"buoyage_uint8", 56}
};
for (const auto& entry : fieldToId) {
const std::string& field = entry.first;
int id = entry.second;
if (root.isMember(field)) {
unsigned char newValue = root[field].asUInt();
DriverCommand cmd;
cmd.id = id;
cmd.cmd = newValue;
driverCmd.push_back(cmd);
}
}
return driverCmd;
}
int Driver::loadDriverTableFromJson(const std::string &strJson, DriverTable& table)
{
Json::CharReaderBuilder builder;
Json::Value root;
std::string errs;
// 解析JSON字符串
std::istringstream s(strJson);
if (!Json::parseFromStream(builder, s, &root, &errs))
{
std::cerr << "JSON解析失败: " << errs << std::endl;
return -3; // 解析失败
}
// 读取 JSON 数据并填充结构体，逐个字段检查
int error_code = 0;
error_code = SafeReadUInt(root, "depth1_uint8", table.depth1);
error_code = SafeReadUInt(root, "depth2_uint8", table.depth2);
error_code = SafeReadUInt(root, "depth3_uint8", table.depth3);
// error_code = SafeReadUInt(root, "overDeep1_uint8", table.overDeep1);
// if (error_code != 0) return error_code;
// error_code = SafeReadUInt(root, "overDeep2_uint8", table.overDeep2);
// if (error_code != 0) return error_code;
error_code = SafeReadUInt(root, "ctd1_uint8", table.ctd1);
error_code = SafeReadUInt(root, "ctd2_uint8", table.ctd2);
error_code = SafeReadUInt(root, "soundVeloc_uint8", table.soundVeloc);
error_code = SafeReadUInt(root, "commDev_uint8", table.commMast);
error_code = SafeReadUInt(root, "ins_uint8", table.ins);
error_code = SafeReadUInt(root, "ntp_uint8", table.ntp);
error_code = SafeReadUInt(root, "inputWaterSensor1_uint8", table.inputWaterSensor1);
error_code = SafeReadUInt(root, "inputWaterSensor2_uint8", table.inputWaterSensor2);
error_code = SafeReadUInt(root, "inputWaterSensor3_uint8", table.inputWaterSensor3);
// 水声设备
error_code = SafeReadUInt(root, "singleBeamSonar1_uint8", table.singleBeamSonar1);
error_code = SafeReadUInt(root, "singleBeamSonar2_uint8", table.singleBeamSonar2);
error_code = SafeReadUInt(root, "singleBeamSonar3_uint8", table.singleBeamSonar3);
error_code = SafeReadUInt(root, "singleBeamSonar4_uint8", table.singleBeamSonar4);
error_code = SafeReadUInt(root, "singleBeamSonar5_uint8", table.singleBeamSonar5);
error_code = SafeReadUInt(root, "singleBeamSonar6_uint8", table.singleBeamSonar6);
error_code = SafeReadUInt(root, "singleBeamSonar7_uint8", table.singleBeamSonar7);
error_code = SafeReadUInt(root, "singleBeamSonar8_uint8", table.singleBeamSonar8);
error_code = SafeReadUInt(root, "forwardSonar_uint8", table.forwardSonar);
error_code = SafeReadUInt(root, "DVL_uint8", table.DVL);
error_code = SafeReadUInt(root, "lowFreqSonar_uint8", table.lowFreqSonar);
error_code = SafeReadUInt(root, "USBL_uint8", table.USBL);
// 执行机构
error_code = SafeReadUInt(root, "bowWaterInet1_uint8", table.bowWaterInet1);
error_code = SafeReadUInt(root, "bowWaterInet2_uint8", table.bowWaterInet2);
error_code = SafeReadUInt(root, "bowWaterInet3_uint8", table.bowWaterInet3);
error_code = SafeReadUInt(root, "bowWaterInet4_uint8", table.bowWaterInet4);
error_code = SafeReadUInt(root, "bowWaterInet5_uint8", table.bowWaterInet5);
error_code = SafeReadUInt(root, "bowWaterInet6_uint8", table.bowWaterInet6);
error_code = SafeReadUInt(root, "bowWaterInet7_uint8", table.bowWaterInet7);
error_code = SafeReadUInt(root, "bowWaterInet8_uint8", table.bowWaterInet8);
error_code = SafeReadUInt(root, "bowRudderDeploy_uint8", table.bowRudderDeploy);
error_code = SafeReadUInt(root, "bowRudderServo1_uint8", table.bowRudderServo1);
error_code = SafeReadUInt(root, "bowRudderServo2_uint8", table.bowRudderServo2);
error_code = SafeReadUInt(root, "bowCover1_uint8", table.bowCover1);
error_code = SafeReadUInt(root, "bowCover2_uint8", table.bowCover2);
error_code = SafeReadUInt(root, "bowCover3_uint8", table.bowCover3);
error_code = SafeReadUInt(root, "bowCover4_uint8", table.bowCover4);
error_code = SafeReadUInt(root, "bowCover5_uint8", table.bowCover5);
error_code = SafeReadUInt(root, "bowCover6_uint8", table.bowCover6);
error_code = SafeReadUInt(root, "waterInject_uint8", table.waterInject);
error_code = SafeReadUInt(root, "mastLiftingServo_uint8", table.mastLiftingServo);
error_code = SafeReadUInt(root, "buoyancyAdjust1_uint8", table.buoyancyAdjust1);
error_code = SafeReadUInt(root, "buoyancyAdjust2_uint8", table.buoyancyAdjust2);
error_code = SafeReadUInt(root, "buoyancyAdjust3_uint8", table.buoyancyAdjust3);
error_code = SafeReadUInt(root, "buoyancyAdjust4_uint8", table.buoyancyAdjust4);
error_code = SafeReadUInt(root, "buoyancyAdjust5_uint8", table.buoyancyAdjust5);
error_code = SafeReadUInt(root, "sternRudderServo1_uint8", table.sternRudderServo1);
error_code = SafeReadUInt(root, "sternRudderServo2_uint8", table.sternRudderServo2);
error_code = SafeReadUInt(root, "sternRudderServo3_uint8", table.sternRudderServo3);
error_code = SafeReadUInt(root, "sternRudderServo4_uint8", table.sternRudderServo4);
error_code = SafeReadUInt(root, "thruster_uint8", table.thruster);
error_code = SafeReadUInt(root, "bowThrow_uint8", table.bowThrow);
error_code = SafeReadUInt(root, "sternThrow_uint8", table.sternThrow);
// 负载
error_code = SafeReadUInt(root, "photoSensor_uint8", table.photoSensor);
error_code = SafeReadUInt(root, "electSensor_uint8", table.electSensor);
error_code = SafeReadUInt(root, "launchControler_uint8", table.launchControler);
error_code = SafeReadUInt(root, "sideSonar_uint8", table.sideSonar);
error_code = SafeReadUInt(root, "buoyage_uint8", table.buoyage);
return 0; // 返回0表示所有数据成功读取
}
Reference in New Issue View Git Blame Copy Permalink