1813 lines
52 KiB
C++
1813 lines
52 KiB
C++
#include "pch.h"
|
|
#include "pch.h"
|
|
#pragma unmanaged
|
|
#include "Epd3Base.h"
|
|
#include "TimeFunctions.h"
|
|
#pragma unmanaged
|
|
#define noDeissueWithClear
|
|
#define ProtectSession
|
|
|
|
#if _DEBUG
|
|
#define DebugWrite(f,...) snprintf(current->DiagnosticsWrite, DiagnosticsWriteSize, f ,__VA_ARGS__); OutputDebugStringA(current->DiagnosticsWrite);
|
|
#else
|
|
#define DebugWrite(f,...) ;
|
|
#endif
|
|
|
|
constexpr int SleepAfterClear = 1000;
|
|
|
|
//-102 = permission
|
|
Epd3Base::Epd3U* current;
|
|
|
|
|
|
void Epd3Base::Epd3U::ResetStepReturnValues()
|
|
{
|
|
CurrentStep = -1;
|
|
HasStepError = 0;
|
|
for (int i = MaxSteps - 1; i >= 0; --i) for (int j = 0; j < 4; j++) StepReturnValues[i][j] = 0;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::SetFunctionReturnValue(enum eFunctions f, BYTE CanIgnore)
|
|
{
|
|
if (CurrentStep < -1) CurrentStep = -1;
|
|
if (CurrentStep < MaxSteps - 1) {
|
|
++CurrentStep;
|
|
if (CurrentStep == 0) HasStepError = 0;
|
|
StepReturnValues[CurrentStep][0] = f;
|
|
StepReturnValues[CurrentStep][1] = -1;
|
|
StepReturnValues[CurrentStep][2] = -1;
|
|
StepReturnValues[CurrentStep][3] = CanIgnore;
|
|
}
|
|
return CurrentStep;
|
|
}
|
|
|
|
void Epd3Base::Epd3U::SetCommitReturnValue(int step, int32_t rv)
|
|
{
|
|
if (CurrentStep >= 0 && CurrentStep < MaxSteps)
|
|
StepReturnValues[step][1] = rv;
|
|
}
|
|
|
|
void Epd3Base::Epd3U::SetCommitReturnValue(int32_t rv)
|
|
{
|
|
SetCommitReturnValue(CurrentStep, rv);
|
|
}
|
|
|
|
uint32_t Epd3Base::Epd3U::SetEndReturnValue(int step, int32_t rv)
|
|
{
|
|
if (step >= 0 && step < MaxSteps) {
|
|
StepReturnValues[step][2] = rv;
|
|
if (rv != 0) {
|
|
HasStepError = 1;
|
|
if (StepReturnValues[step][3]) rv = 0; //if canIngore set rv ok
|
|
Error = GetErrorCode();
|
|
}
|
|
}
|
|
return rv;
|
|
}
|
|
|
|
uint32_t Epd3Base::Epd3U::SetEndReturnValue(int32_t rv)
|
|
{
|
|
return SetEndReturnValue(CurrentStep, rv);
|
|
}
|
|
|
|
int32_t Epd3Base::Epd3U::CommitAndSetRV()
|
|
{
|
|
int32_t r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
return r;
|
|
}
|
|
|
|
int32_t Epd3Base::Epd3U::CommitAndSetRV(int idx[], int len)
|
|
{
|
|
int32_t r = Commit3(epdComsHandle);
|
|
for(int i = 0; i < len ;++i)
|
|
SetCommitReturnValue(idx[i],r);
|
|
return r;
|
|
}
|
|
|
|
int32_t Epd3Base::Epd3U::CommitAndEnd2RV(int32_t (WINAPI *endFunction2)(CommsHandle hComms, CompletionToken token), CompletionToken token)
|
|
{
|
|
int32_t r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) r = (*endFunction2)(epdComsHandle, token);
|
|
r= SetEndReturnValue(r);
|
|
return r;
|
|
}
|
|
|
|
int32_t Epd3Base::Epd3U::End2RV(int step, int32_t(WINAPI* endFunction2)(CommsHandle hComms, CompletionToken token), CompletionToken token)
|
|
{
|
|
int32_t r = (*endFunction2)(epdComsHandle, token);
|
|
r = SetEndReturnValue(step,r);
|
|
return r;
|
|
}
|
|
|
|
void WINAPI completion(CommsHandle hComms, CompletionToken token)
|
|
{
|
|
SetEvent(current->hCompletion);
|
|
}
|
|
|
|
void WINAPI discovery(CommsHandle hComms, DiscoveryId const discovered[], int32_t count)
|
|
{
|
|
if (count > 0)
|
|
{
|
|
memcpy(¤t->Epd, &discovered[0], sizeof(DiscoveryId));
|
|
current->CurrentDeviceID = discovered[0].Id;
|
|
current->DeviceCount = count;
|
|
SetEvent(current->hCompletion);
|
|
current->isMK3 = (current->Epd.Gen == EpdGeneration::Mk3);
|
|
current->EpdID = current->Epd.Id;
|
|
}
|
|
}
|
|
|
|
void WINAPI connectcallback(CommsHandle hComms, DiscoveryId ID)
|
|
{
|
|
current->isConnected = 1;
|
|
current->CurrentDeviceID = ID.Id;
|
|
current->DeviceCount = 1;
|
|
}
|
|
|
|
void WINAPI disconnectcallback(CommsHandle hComms, DiscoveryId ID)
|
|
{
|
|
OutputDebugStringA("**** Disconnect ****\n");
|
|
current->isConnected = 0;
|
|
current->CurrentDeviceID = 0;
|
|
current->DeviceCount = 0;
|
|
SetEvent(current->hCompletion);
|
|
}
|
|
|
|
Epd3Base::Epd3U::Epd3U(int _comport)
|
|
{
|
|
port = _comport;
|
|
comPort[3] = 48 + _comport;
|
|
CommsInitialized = 0;
|
|
epdComsHandle = nullptr;
|
|
isBG = isNG = VersionOK = 0;
|
|
Error = 123;
|
|
current = this;
|
|
|
|
DeviceCount = 0;
|
|
BaseCountsClock = 0;
|
|
CurrentDeviceID = 0;
|
|
countsRead = 0; utc = 0; seconds = 0;
|
|
memset(WearerID, 0, WearerIDLength + 1);
|
|
memset(WearerName, 0, WearerNameLength + 1);
|
|
Error = 0;
|
|
EpdID = 4567;
|
|
EpdType = EpdTypes::Mk2BetaGamma;
|
|
isBG = 1; isNG = 0; VersionOK = 1;
|
|
isMK3 = true;
|
|
FunctionFlags = 0x000;
|
|
Epd.Gen = EpdGeneration::None;
|
|
Epd.MaxBaud = 0;
|
|
Epd.Id = EpdID;
|
|
|
|
OperatingStatus = (OpStatusFlags)0U;
|
|
AlarmStatus = (AlarmStatusFlags)0U;
|
|
ErrorStatus = (FaultStatusFlags)0;
|
|
IssueCount = OtherAlarms = EEPROMBadSectors = 0;
|
|
RealTime = EpdClock = OffTime = EpdID = 0;
|
|
EPDFaulty = false;
|
|
hasAlarm = hasFault = 0;
|
|
ErrorSource = ErrorReason = ErrorData = 0;
|
|
HardVersion = HardVersionMinor = SoftVersion = FunctionFlags = 0;
|
|
|
|
K1 = K2 = K3 = K4 = K4 = K6 = 0.0F;
|
|
HG = SG = BC = FB = 0;
|
|
D1 = D2 = D3 = D4 = 0;
|
|
Hp10Total = Hp07Total = 0;
|
|
Hp10Dose = Hp07Dose = 0;
|
|
Hp10Peak = Hp07Peak = 0;
|
|
Hp10Time = Hp07Time = 0;
|
|
Hp10FTime = Hp07FTime = 0;
|
|
|
|
Hp07THDose = 0; Hp07RateOn = 0; Hp07RateOff = 0;
|
|
Hp07THDoseA = 0; Hp07RateAOn = 0; Hp07RateAOff = 0;
|
|
Hp10THDose1 = 0; Hp10Rate1On = 0; Hp10Rate1Off = 0;
|
|
Hp10THDose2 = 0; Hp10Rate2On = 0; Hp10Rate2Off = 0;
|
|
|
|
|
|
if (_comport == 0) return;
|
|
if (hCompletion == 0) hCompletion = CreateEvent(NULL, TRUE, FALSE, NULL);
|
|
|
|
|
|
}
|
|
|
|
Epd3Base::Epd3U::~Epd3U()
|
|
{
|
|
EndCom(isConnected);
|
|
if (hCompletion != 0) { CloseHandle(hCompletion); hCompletion = 0; }
|
|
//if (hWaitTimer != 0) { CloseHandle(hWaitTimer); hWaitTimer = 0; }
|
|
}
|
|
|
|
int Epd3Base::Epd3U::DisconnectAndConnect()
|
|
{
|
|
int rv = 0;
|
|
rv = Disconnect(epdComsHandle);
|
|
Sleep(200);
|
|
rv = SetConnectCallback(epdComsHandle, connectcallback);
|
|
int tries = 3; rv = 1;
|
|
while (rv && --tries>=0) {
|
|
rv = Connect3(epdComsHandle, Epd, true);
|
|
DebugWrite( "**** DisconnectAndConnect rv=%d tries %d ****\n", rv, tries);
|
|
Sleep(100);
|
|
}
|
|
|
|
return rv;
|
|
}
|
|
|
|
|
|
DWORD Epd3Base::Epd3U::StartCom()
|
|
{
|
|
ErrorReason = 0;
|
|
ConnectRetries = 0;
|
|
OpenRetries = 0;
|
|
int step = 1;
|
|
int mx = 10;
|
|
|
|
epdComsHandle = nullptr;
|
|
if (port == 0) {
|
|
CommsInitialized = 1;
|
|
return 1;
|
|
}
|
|
|
|
if (CommsInitialized == 0 || epdComsHandle == nullptr) {
|
|
step = 2;
|
|
SetFunctionReturnValue(fCreateReaderInterface, 0);
|
|
epdComsHandle = CreateReaderInterface();
|
|
if (!epdComsHandle ) step = 3;
|
|
while (epdComsHandle == nullptr && ++ConnectRetries < 4) {
|
|
Sleep(200);
|
|
epdComsHandle = CreateReaderInterface(); //try again;
|
|
}
|
|
SetCommitReturnValue(0);
|
|
if (epdComsHandle) SetEndReturnValue(0); else SetEndReturnValue(-1);
|
|
|
|
if (epdComsHandle != nullptr) {
|
|
step = 4;
|
|
SetFunctionReturnValue(fOpenReader, 0);
|
|
Dll3RV = OpenReader(epdComsHandle, comPort); //-6 = r_OperationFailed
|
|
if (Dll3RV) step = 5;
|
|
while (Dll3RV && ++OpenRetries <4 ) { //retry
|
|
Sleep(200);
|
|
Dll3RV = OpenReader(epdComsHandle, comPort);
|
|
}
|
|
SetCommitReturnValue(0);
|
|
if (!Dll3RV) SetEndReturnValue(0); else SetEndReturnValue(-1);
|
|
|
|
if (Dll3RV == 0)
|
|
{
|
|
step = 7;
|
|
CommsInitialized = 1;
|
|
Dll3RV = SetMultipleDiscoveryMode(epdComsHandle, false);
|
|
Dll3RV = SetResponseTimeout(epdComsHandle, ResponseTimeout);
|
|
}
|
|
}
|
|
else {
|
|
Dll3RV = r_FunctionFail;
|
|
}
|
|
}
|
|
if (Dll3RV) goto error;
|
|
return Dll3RV;
|
|
error:
|
|
ErrorStep = step;
|
|
Error = Dll3RV;
|
|
return Dll3RV;
|
|
}
|
|
|
|
void Epd3Base::Epd3U::EndCom(bool doDiscon)
|
|
{
|
|
int rv;
|
|
|
|
if (CommsInitialized == 1 || CurrentDeviceID != 0) {
|
|
if (CommsInitialized == 1) {
|
|
DebugWrite( "**** EndCom(%d) is Connected=%d ****\n", doDiscon, isConnected);
|
|
|
|
if (epdComsHandle != nullptr) {
|
|
if (doDiscon && isConnected) { DisCon(0); }
|
|
//Dll3RV = CloseReader(epdComsHandle); // not necessary if followed by DestroyReaderInterface
|
|
//if (Dll3RV) {
|
|
// rv = 1;
|
|
//}
|
|
SetFunctionReturnValue(eFunctions::fDestroyReaderInterface,0);
|
|
Dll3RV = DestroyReaderInterface(epdComsHandle);
|
|
SetCommitReturnValue(0);
|
|
SetEndReturnValue(Dll3RV);
|
|
if (Dll3RV) rv = 1;
|
|
}
|
|
}
|
|
Epd.Id = 0;
|
|
CurrentDeviceID = 0;
|
|
CommsInitialized = 0;
|
|
epdComsHandle = nullptr;
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
///
|
|
/// </summary>
|
|
/// <param name="tokentimeout"></param>
|
|
/// <returns>rv=1 ,ook bij timeout <>1 voor error</returns>
|
|
int Epd3Base::Epd3U::StartDiscover(int tokentimeout)
|
|
{
|
|
int32_t rv = 1;
|
|
int32_t rv2 = 0;
|
|
Error = 0;
|
|
if (port == 0) {
|
|
DeviceCount = 1;
|
|
isBG = 1;
|
|
DeviceIDs[0] = 768;
|
|
return 0;
|
|
}
|
|
|
|
current = this;
|
|
Dll3RV = SetDiscoveryCacheTimeout(epdComsHandle, tokentimeout);
|
|
DeviceCount = 0;
|
|
ResetEvent(hCompletion);
|
|
ConnectTimerFired = 0;
|
|
isConnected = 0;
|
|
|
|
Dll3RV = StartDiscovery(epdComsHandle, discovery);
|
|
if (Dll3RV == 0) {
|
|
Dll3RV = WaitForSingleObject(hCompletion, tokentimeout);
|
|
if (Dll3RV == WAIT_OBJECT_0) rv = 1;
|
|
else if (Dll3RV == WAIT_TIMEOUT) {
|
|
rv = 1;
|
|
ConnectTimerFired = 1;
|
|
rv2 = StopDiscovery(epdComsHandle);
|
|
DeviceCount = 0;
|
|
}
|
|
else rv = 2;
|
|
}
|
|
if (DeviceCount > 0) {
|
|
Dll3RV = SetConnectCallback(epdComsHandle, connectcallback);
|
|
Dll3RV = Connect3(epdComsHandle, Epd, true);
|
|
if (Dll3RV != 0) rv = 2;
|
|
else {
|
|
Dll3RV = SetDisconnectCallback(epdComsHandle, disconnectcallback);
|
|
}
|
|
}
|
|
return rv;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::OpenDev(DiscoveryId DeviceID)
|
|
{
|
|
CurrentDeviceID = DeviceID.Id;
|
|
if (epdComsHandle != nullptr)
|
|
{
|
|
Dll3RV = Connect3(epdComsHandle, DeviceID, true);
|
|
SetDisconnectCallback(epdComsHandle, disconnectcallback);
|
|
OutputDebugStringA("**** Open ****\n");
|
|
|
|
}
|
|
else { Dll3RV = r_InvalidCommsHandle; }
|
|
return Dll3RV;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::ReOpenDev()
|
|
{
|
|
if (epdComsHandle != nullptr)
|
|
{
|
|
SetDisconnectCallback(epdComsHandle, disconnectcallback);
|
|
Dll3RV = Connect3(epdComsHandle, Epd, true);
|
|
OutputDebugStringA("**** ReOpen ****\n");
|
|
}
|
|
else {
|
|
OutputDebugStringA("**** ReOpen no epdComsHandle ****\n");
|
|
Dll3RV = r_InvalidCommsHandle;
|
|
} //no handle ..
|
|
return Dll3RV;
|
|
}
|
|
|
|
//
|
|
|
|
int Epd3Base::Epd3U::DisCon(UINT16 alarm)
|
|
{
|
|
// 5432109876543210
|
|
constexpr UINT16 ca = 0b1001110011000111;
|
|
int rv = 0;
|
|
int step = 0;
|
|
DebugWrite( "**** Discon(%hu) ****\n", alarm);
|
|
|
|
if (CurrentDeviceID != 0) {
|
|
ResetEvent(hCompletion);
|
|
current = this;
|
|
step = 1;
|
|
Dll3RV = SetDisconnectCallback(epdComsHandle, disconnectcallback);
|
|
if (alarm) {
|
|
DebugWrite("**** DisconnectAndNotify(%hX,15) HardVersionMinor: %d ****\n", ca, HardVersionMinor);
|
|
|
|
if (HardVersionMinor > 0) {
|
|
SetFunctionReturnValue(TestVibe, 0);
|
|
token = BeginTestVibe_R3(epdComsHandle, 1.0 , nullptr);
|
|
rv = CommitAndEnd2RV(EndTestVibe_R3, token);
|
|
}
|
|
|
|
|
|
SetFunctionReturnValue(fDisconnectAndNotify,0);
|
|
Dll3RV = DisconnectAndNotify(epdComsHandle, ca, 12); //1.2 secon
|
|
SetCommitReturnValue(0); SetEndReturnValue(Dll3RV);
|
|
Sleep(1200);
|
|
} else {
|
|
SetFunctionReturnValue(fDisconnect,0);
|
|
Dll3RV = Disconnect(epdComsHandle);
|
|
SetCommitReturnValue(0); SetEndReturnValue(Dll3RV);
|
|
}
|
|
|
|
if (Dll3RV) { rv = Dll3RV; goto error; }
|
|
|
|
step = 2;
|
|
Dll3RV = WaitForSingleObject(hCompletion, 3000);
|
|
switch (Dll3RV) {
|
|
case WAIT_OBJECT_0:
|
|
rv = 0; break;
|
|
case WAIT_TIMEOUT:
|
|
rv = 0;
|
|
current->CurrentDeviceID = 0;
|
|
current->DeviceCount = 0;
|
|
break;
|
|
default: rv = 3; break;
|
|
}
|
|
}
|
|
return rv;
|
|
error:
|
|
return rv;
|
|
}
|
|
|
|
void Epd3Base::Epd3U::CloseDev(bool CloseAll)
|
|
{
|
|
if (epdComsHandle != nullptr) {
|
|
DisCon(0);
|
|
if (CloseAll) {
|
|
//CloseReader(epdComsHandle);
|
|
DestroyReaderInterface(epdComsHandle);
|
|
epdComsHandle = nullptr;
|
|
}
|
|
}
|
|
}
|
|
|
|
BYTE checkStatus(OpStatusFlags status, OpStatusFlags flag)
|
|
{
|
|
if (((uint32_t)status & (uint32_t)flag) == (uint32_t)flag) return 1; else return 0;
|
|
}
|
|
|
|
BYTE checkStatus(FaultStatusFlags status, FaultStatusFlags flag)
|
|
{
|
|
if (((uint32_t)status & (uint32_t)flag) == (uint32_t)flag) return 1; else return 0;
|
|
}
|
|
|
|
BYTE checkStatus(AlarmStatusFlags status, AlarmStatusFlags flag)
|
|
{
|
|
uint32_t ustatus = (uint32_t)status;
|
|
uint32_t uflag = (uint32_t)flag;
|
|
if ((ustatus & uflag) == uflag) return 1; else return 0;
|
|
}
|
|
|
|
BYTE checkStatus(DoseAlarmFlags status, DoseAlarmFlags flag)
|
|
{
|
|
if (((uint32_t)status & (uint32_t)flag) == (uint32_t)flag) return 1; else return 0;
|
|
}
|
|
|
|
void Epd3Base::Epd3U::DecodeStatus()
|
|
{
|
|
eDosDose07Warning = eDosDose07Alarm = eDosDose10Warning = eDosDose10Alarm = eDosRate07Warning = eDosRate07Alarm = eDosRate10Warning = eDosRate10Alarm = eDosBatteryWarning = eDosDoseAlarm = eDosRateAlarm = 0;
|
|
AlarmDoseHP07N = AlarmRateHP07N = AlarmDoseHP101G = AlarmDoseHP102G = AlarmRateHP101G = AlarmRateHP102G= 0;
|
|
hasAlarm = hasFault = false;
|
|
|
|
DetectorsOn = checkStatus(epd3status.OperatingStatus, OpStatusFlags::EpdOn);
|
|
EPDIssued = checkStatus(epd3status.OperatingStatus, OpStatusFlags::EpdIssued);
|
|
EPDLocked = checkStatus(epd3status.OperatingStatus, OpStatusFlags::GainAdjustable);
|
|
EPDTesting = checkStatus(epd3status.OperatingStatus, OpStatusFlags::DetectorTestRequested);
|
|
|
|
EPDFaulty = checkStatus(epd3status.FaultStatus, FaultStatusFlags::EpdFaulty);
|
|
EPDNewFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::ErrorLogged);
|
|
EPDComFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::EarlyCommsTermination);
|
|
EPDCalFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::NotCalibrated);
|
|
EPDDetFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::DetectorTestFail);
|
|
EPDEprFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::EepromFailure);
|
|
EPDTrhFault = checkStatus(epd3status.FaultStatus, FaultStatusFlags::BadThreshold);
|
|
|
|
for (int ix = 0; ix < 4; ix++)
|
|
{
|
|
DoseAlarmFlags status = epd3status.DoseAlarms[ix].Status;
|
|
switch ((MeasurementId)epd3status.DoseAlarms[ix].Id)
|
|
{
|
|
case MeasurementId::Meas_Hp07:
|
|
case MeasurementId::Meas_Hp10N:
|
|
eDosDose07Warning = checkStatus(status, DoseAlarmFlags::DoseWarning);
|
|
eDosDose07Alarm = checkStatus(status, DoseAlarmFlags::DoseAlarm);
|
|
eDosRate07Warning = checkStatus(status, DoseAlarmFlags::RateWarning);// | checkStatus(status, DoseAlarmFlags::LatchedRateWarning);
|
|
eDosRate07Alarm = checkStatus(status, DoseAlarmFlags::RateAlarm) ; // checkStatus(status, DoseAlarmFlags::LatchedRateAlarm)
|
|
AlarmDoseHP07N = checkStatus(status, DoseAlarmFlags::DoseAlarm);
|
|
AlarmRateHP07N = checkStatus(status, DoseAlarmFlags::RateAlarm);; // | checkStatus(status, DoseAlarmFlags::LatchedRateAlarm);
|
|
break;
|
|
case MeasurementId::Meas_Hp10:
|
|
case MeasurementId::Meas_Hp10G:
|
|
eDosDose10Warning = checkStatus(status, DoseAlarmFlags::DoseWarning);
|
|
eDosDose10Alarm = checkStatus(status, DoseAlarmFlags::DoseAlarm);
|
|
eDosRate10Warning = checkStatus(status, DoseAlarmFlags::LatchedRateWarning) | checkStatus(status, DoseAlarmFlags::RateWarning);
|
|
eDosRate10Alarm = checkStatus(status, DoseAlarmFlags::LatchedRateAlarm) | checkStatus(status, DoseAlarmFlags::RateAlarm);
|
|
AlarmDoseHP101G = checkStatus(status, DoseAlarmFlags::DoseAlarm);
|
|
AlarmDoseHP102G = AlarmDoseHP101G;
|
|
AlarmRateHP101G = checkStatus(status, DoseAlarmFlags::RateAlarm) | checkStatus(status, DoseAlarmFlags::LatchedRateAlarm);
|
|
AlarmRateHP102G = AlarmRateHP101G;
|
|
break;
|
|
}
|
|
}
|
|
|
|
OtherAlarmReturn = checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::ReturnForRead);
|
|
OtherAlarmBatLow = checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::LowBattery);
|
|
OtherAlarmCarrier = checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::TelemetryAlert);
|
|
OtherAlarmBatVolt = checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::LowBattery);
|
|
|
|
eDosDoseAlarm = (eDosDose10Alarm || eDosDose07Alarm) && checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::DoseAlarm);
|
|
eDosRateAlarm = (eDosRate07Alarm || eDosRate10Alarm) && checkStatus(epd3status.AlarmStatus, AlarmStatusFlags::RateAlarm);
|
|
|
|
hasAlarm = eDosDoseAlarm || eDosRateAlarm;
|
|
hasFault = ((uint32_t)epd3status.FaultStatus & ~(uint32_t)FaultStatusFlags::ErrorLogged) != 0;
|
|
eDosBatteryWarning = OtherAlarmBatLow | OtherAlarmBatVolt;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::SetTime() //Only R3
|
|
{
|
|
int r = 0;
|
|
if (Epd.Gen == EpdGeneration::Mk3)
|
|
{
|
|
SetFunctionReturnValue(WriteRTC_R3,1);
|
|
utc = TimeFunctions::NowToEpdTime(Epd.Gen == EpdGeneration::Mk2);
|
|
token = BeginWriteRTC_R3(epdComsHandle, utc, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteRTC_R3, token);
|
|
}
|
|
return r;
|
|
}
|
|
|
|
void WINAPI ReadStatusCompletion(CommsHandle hComms, CompletionToken token)
|
|
{
|
|
int rv = EndReadStatus(current->epdComsHandle, token, ¤t->epd3status);
|
|
rv = current->SetEndReturnValue(rv);
|
|
current->IssueCount = current->epd3status.IssueCount;
|
|
current->OperatingStatus = current->epd3status.OperatingStatus;
|
|
current->AlarmStatus = current->epd3status.AlarmStatus;
|
|
current->ErrorStatus = current->epd3status.FaultStatus;
|
|
current->OtherAlarms = current->epd3status.OtherBits;
|
|
current->DecodeStatus(); //Alarm status...
|
|
DebugWrite("**** ReadStatusCompletion %04x ****\n", current->OperatingStatus);
|
|
SetEvent(current->hCompletion);
|
|
}
|
|
|
|
int Epd3Base::Epd3U::ReadStatusOnly()
|
|
{
|
|
int rv = 0;
|
|
ResetEvent(hCompletion);
|
|
SetFunctionReturnValue(eFunctions::ReadStatus, 0);
|
|
token = BeginReadStatus(epdComsHandle, ReadStatusCompletion);
|
|
rv = CommitAndSetRV();
|
|
return rv;
|
|
}
|
|
/// <summary>
|
|
///
|
|
/// </summary>
|
|
/// <returns>0 = ok</returns>
|
|
int Epd3Base::Epd3U::ReadStatus(bool onlyStatus)
|
|
{
|
|
int rv; //0=ok
|
|
//constexpr int maxbatch = 2;
|
|
//int batchstep;
|
|
//int s[maxbatch];
|
|
//int r[maxbatch];
|
|
int step = 0;
|
|
uint8_t length = 0;
|
|
countsRead = 0; utc = 0; seconds = 0;
|
|
memset(WearerID, 0, WearerIDLength + 1);
|
|
memset(WearerName, 0, WearerNameLength + 1);
|
|
rv = SetResponseTimeout(epdComsHandle, ResponseTimeout);
|
|
Error = 0;
|
|
if (port == 0) {
|
|
EpdID = 4567;
|
|
EpdType = EpdTypes::Mk2BetaGamma;
|
|
isBG = 1; isNG = 0; VersionOK = 1;
|
|
isMK3 = true;
|
|
FunctionFlags = 0x000;
|
|
Epd.Gen = EpdGeneration::None;
|
|
Epd.MaxBaud = 0;
|
|
Epd.Id = EpdID;
|
|
return 0;
|
|
}
|
|
|
|
isMK3 = Epd.Gen == EpdGeneration::Mk3;
|
|
OperatingStatus = (OpStatusFlags)0U;
|
|
AlarmStatus = (AlarmStatusFlags)0U;
|
|
ErrorStatus = (FaultStatusFlags)0;
|
|
IssueCount = OtherAlarms = EEPROMBadSectors = 0;
|
|
RealTime = EpdClock = OffTime = EpdID = 0;
|
|
ErrorSource = ErrorReason = ErrorData = 0;
|
|
HardVersion = HardVersionMinor = SoftVersion = FunctionFlags = 0;
|
|
|
|
step = 1;
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadStatus,0);
|
|
token = BeginReadStatus(epdComsHandle, nullptr);
|
|
rv = CommitAndSetRV();
|
|
|
|
//batchstep = 0; //ReadStatus
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r);
|
|
if (!rv) rv = EndReadStatus(epdComsHandle, token, &epd3status);
|
|
rv = SetEndReturnValue(rv);
|
|
if (rv != 0) goto error;
|
|
|
|
IssueCount = epd3status.IssueCount;
|
|
OperatingStatus = epd3status.OperatingStatus;
|
|
AlarmStatus = epd3status.AlarmStatus;
|
|
ErrorStatus = epd3status.FaultStatus;
|
|
OtherAlarms = epd3status.OtherBits;
|
|
DecodeStatus(); //Alarm status...
|
|
|
|
if (onlyStatus) goto exitroutine;
|
|
|
|
uint32_t EpdID32 ;
|
|
uint32_t capabilities;
|
|
MarkNumber_t MarkNumber;
|
|
VersionNumber_t VersionNumber;
|
|
|
|
step = 2;
|
|
//batchstep = 1; //ReadEpdIdentities
|
|
|
|
|
|
EpdID32 = 0;
|
|
MarkNumber.Major = 0;
|
|
MarkNumber.Minor=0;
|
|
VersionNumber.Major = 0;
|
|
|
|
SetFunctionReturnValue(ReadEpdIdentities,0);
|
|
token = BeginReadEpdIdentities(epdComsHandle, nullptr);
|
|
rv = CommitAndSetRV();
|
|
if (!rv) rv = EndReadEpdIdentities(epdComsHandle, token, &EpdID32, (EpdTypes*)&EpdType, &capabilities, &MarkNumber, &VersionNumber, NULL, 0);
|
|
rv = SetEndReturnValue(rv);
|
|
if (rv != 0) goto error;
|
|
|
|
|
|
EpdID = EpdID32;
|
|
isBG = (EpdType == EpdTypes::Mk2BetaGamma || EpdType == EpdTypes::Mk3BetaGamma);
|
|
isNG = (EpdType == EpdTypes::Mk2Neutron || EpdType == EpdTypes::Mk3Neutron);
|
|
HardVersion = MarkNumber.Major;
|
|
HardVersionMinor = MarkNumber.Minor;
|
|
SoftVersion = VersionNumber.Major;
|
|
VersionOK = true;
|
|
|
|
|
|
step = 3;
|
|
|
|
SetFunctionReturnValue(ReadCounts,0);
|
|
token = BeginReadCounts(epdComsHandle, nullptr, 0, nullptr);
|
|
rv = CommitAndSetRV();
|
|
if (!rv) rv = EndReadCounts(epdComsHandle, token, Counts, MaxCounts, &countsRead, &utc, &seconds);
|
|
rv= SetEndReturnValue(rv);
|
|
if (rv) goto error;
|
|
decodeCounters(countsRead); //HG,SG ..
|
|
|
|
//Times
|
|
//1601-01-01T00:00:00Z.
|
|
//MK2 .. some utc... but no real time clock
|
|
step = 6;
|
|
//batchstep = 3;
|
|
if (utc == 0) {
|
|
SetFunctionReturnValue(ReadRTC,0);
|
|
token = BeginReadRTC(epdComsHandle, nullptr);
|
|
rv = CommitAndSetRV();
|
|
if (!rv) rv = EndReadRTC(epdComsHandle, token, &utc); //EpdClock for MK2
|
|
rv= SetEndReturnValue(rv);
|
|
if (rv) goto error;
|
|
EpdClock = utc;
|
|
utc = TimeFunctions::NowToEpdTime(true);
|
|
}
|
|
else {
|
|
EpdClock = utc;
|
|
}
|
|
|
|
FILETIME fUTC;
|
|
TimeFunctions::EpdTimeToFileTime(utc, &fUTC, Epd.Gen == EpdGeneration::Mk2);
|
|
FileTimeToSystemTime(&fUTC, &tRealTime);
|
|
|
|
step = 4;
|
|
if (EPDIssued) {
|
|
IdString_t mk3WearerID;
|
|
mk3WearerID.Length = 0;
|
|
//Mk2 EPDs only support Name and Primary ID
|
|
|
|
//batchstep = 0;
|
|
SetFunctionReturnValue(ReadWearerId, 0);
|
|
token= BeginReadWearerId(epdComsHandle, static_cast<uint16_t>(WearerIdType::WearerId_Name), nullptr);
|
|
rv = CommitAndSetRV();
|
|
|
|
if (!rv) rv = EndReadWearerId(epdComsHandle, token, &mk3WearerID);
|
|
rv = SetEndReturnValue(rv);
|
|
if (rv != 0) goto error;
|
|
|
|
if (mk3WearerID.Length > WearerNameLength) mk3WearerID.Length = WearerNameLength;
|
|
memcpy(WearerName, mk3WearerID.Utf8String, mk3WearerID.Length); WearerName[mk3WearerID.Length] = 0;
|
|
|
|
step = 5;
|
|
//batchstep = 1;
|
|
SetFunctionReturnValue(ReadWearerId, 0);
|
|
token = BeginReadWearerId(epdComsHandle, static_cast<uint16_t>(WearerIdType::WearerId_Primary), nullptr);
|
|
rv = CommitAndSetRV();
|
|
if (!rv) rv = EndReadWearerId(epdComsHandle, token, &mk3WearerID);
|
|
rv = SetEndReturnValue(rv);
|
|
if (rv != 0) goto error;
|
|
|
|
|
|
if (mk3WearerID.Length > WearerIDLength) mk3WearerID.Length = WearerIDLength;
|
|
memcpy(this->WearerID, mk3WearerID.Utf8String, mk3WearerID.Length); WearerName[mk3WearerID.Length] = 0;
|
|
for (int i = 0; i < mk3WearerID.Length; i++)
|
|
if (WearerID[i] == 0xb) WearerID[i] = '0'; else WearerID[i] |= 0x30;
|
|
}
|
|
|
|
exitroutine:
|
|
return rv;
|
|
|
|
error:
|
|
//Cancel(epdComsHandle);
|
|
Error = rv;
|
|
ErrorStep = step;
|
|
return rv;
|
|
|
|
}
|
|
/// <summary>
|
|
/// discover, connect and read status
|
|
/// </summary>
|
|
/// <param name="tokenSourceTimeout"></param>
|
|
/// <returns>0=success 1=connect error, 2 = time out , no devices, 3= error reading status</returns>
|
|
int Epd3Base::Epd3U::ConnectAndStatus(int tokenSourceTimeout)
|
|
{
|
|
WORD dllStatus;
|
|
int rv = 1;
|
|
Error = 0; ErrorStep = 0; hasAlarm = hasFault = 0;
|
|
ResetStepReturnValues();
|
|
if (CommsInitialized == 0) StartCom();
|
|
if (CommsInitialized) {
|
|
SetFunctionReturnValue(fStartDiscover,0);
|
|
dllStatus = StartDiscover(tokenSourceTimeout);
|
|
SetCommitReturnValue(0);
|
|
if (dllStatus==1) SetEndReturnValue(0); else SetEndReturnValue(dllStatus);
|
|
|
|
if (dllStatus != 1) rv = 1; //Connect error
|
|
else if (DeviceCount < 1) rv = 2; //TO
|
|
else if (isMK3 && ReadStatus(false) != 0) rv = 1; //Read Error
|
|
else rv = 0;
|
|
}
|
|
else rv = 1;
|
|
return rv;
|
|
}
|
|
/// <summary>
|
|
/// K1 = K2 = K3 = K4 = K4 = K6 (*100000 )
|
|
/// </summary>
|
|
/// <param name="count"></param>
|
|
|
|
void Epd3Base::Epd3U::decodeSensitivities(int count) {
|
|
|
|
K1 = K2 = K3 = K4 = K4 = K6 = 0.0F;
|
|
for (int ix = count - 1; ix >= 0; ix--) {
|
|
switch ((SensitivityId)sensitivities[ix].id)
|
|
{
|
|
case SensitivityId::Hg1Sens10G: K1 = sensitivities[ix].value * 100000; break;
|
|
case SensitivityId::Sg1Sens10G: K2 = sensitivities[ix].value * 100000; break;
|
|
case SensitivityId::Hg1Sens07G: K3 = sensitivities[ix].value * 100000; break; //Neutr=FN
|
|
case SensitivityId::Sg1Sens07G: K4 = sensitivities[ix].value * 100000; break; //Neutr=AN
|
|
case SensitivityId::Fb1Sens07B: K5 = sensitivities[ix].value * 100000; break;
|
|
case SensitivityId::Sg2Sens07B: K6 = sensitivities[ix].value * 100000; break;
|
|
default: break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodetotDoses(int count)
|
|
{
|
|
//doses
|
|
Hp10Total = Hp07Total = 0;
|
|
for (int ix = 0; ix < count; ix++)
|
|
{
|
|
switch ((MeasurementId)doses[ix].id) {
|
|
case MeasurementId::Meas_Hp07: Hp07Total = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10: Hp10Total = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10N: Hp07Total = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10G: Hp10Total = doses[ix].value; break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodeDoses(int count)
|
|
{
|
|
//doses
|
|
Hp10Dose = Hp07Dose = 0;
|
|
for (int ix = 0; ix < count; ix++)
|
|
{
|
|
switch ((MeasurementId)doses[ix].id) {
|
|
case MeasurementId::Meas_Hp07: Hp07Dose = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10: Hp10Dose = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10N: Hp07Dose = doses[ix].value; break;
|
|
case MeasurementId::Meas_Hp10G: Hp10Dose = doses[ix].value; break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodePeakRates(int count)
|
|
{
|
|
//Rates
|
|
Hp10Peak = Hp07Peak = 0;
|
|
Hp10Time = Hp07Time = 0;
|
|
|
|
/*SYSTEMTIME st07,st10;*/
|
|
for (int ix = 0; ix < count; ix++)
|
|
{
|
|
switch ((MeasurementId)peakRates[ix].id) {
|
|
case MeasurementId::Meas_Hp07:
|
|
case MeasurementId::Meas_Hp10N:
|
|
Hp07Peak = peakRates[ix].value;
|
|
Hp07Time = peakRates[ix].timestamp;
|
|
TimeFunctions::EpdTimeToFileTime(Hp07Time, (LPFILETIME)&Hp07FTime, false);
|
|
//FileTimeToSystemTime(&Hp07FTime, &st07);
|
|
break;
|
|
case MeasurementId::Meas_Hp10:
|
|
case MeasurementId::Meas_Hp10G:
|
|
Hp10Peak = peakRates[ix].value;
|
|
Hp10Time = peakRates[ix].timestamp;
|
|
TimeFunctions::EpdTimeToFileTime(Hp10Time, (LPFILETIME)&Hp10FTime, false);
|
|
//FileTimeToSystemTime(&Hp10FTime, &st10);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodeCounters(int count)
|
|
{
|
|
HG = SG = BC = FB = 0;
|
|
for (int ix = 0; ix < count; ix++)
|
|
{
|
|
switch ((CounterType)Counts[ix].type) {
|
|
case CounterType::Counter_Hg1: HG = Counts[ix].value; break;
|
|
case CounterType::Counter_Sg1: SG = Counts[ix].value; break;
|
|
case CounterType::Counter_Sg2: BC = Counts[ix].value; break;
|
|
case CounterType::Counter_Fb1: FB = Counts[ix].value; break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodeBaseCounters(int count)
|
|
{
|
|
D1 = D2 = D3 = D4 = 0;
|
|
for (int ix = 0; ix < count; ix++)
|
|
{
|
|
switch ((CounterType)Counts[ix].type) {
|
|
case CounterType::Counter_Hg1: D1 = Counts[ix].value; break;
|
|
case CounterType::Counter_Sg1: D2 = Counts[ix].value; break;
|
|
case CounterType::Counter_Sg2: D3 = Counts[ix].value; break;
|
|
case CounterType::Counter_Fb1: D4 = Counts[ix].value; break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::decodeTreshold(Mk3AlarmThresholds_t* th)
|
|
{
|
|
float* pThDose = nullptr, * pThRate = nullptr, * pTHDoseWarning = nullptr, * pTHRateWarning = nullptr;
|
|
switch ((MeasurementId)th->MeasId)
|
|
{
|
|
case MeasurementId::Meas_Hp07:
|
|
case MeasurementId::Meas_Hp10N:
|
|
Hp07THDose = 0; Hp07RateOn = 0; Hp07RateOff = 0;
|
|
pThDose = &Hp07THDose;
|
|
pThRate = &Hp07RateOn;
|
|
pTHDoseWarning = &Hp07THDoseA;
|
|
pTHRateWarning = &Hp07RateAOn;
|
|
break;
|
|
case MeasurementId::Meas_Hp10:
|
|
Hp10THDose1 = 0; Hp10THDose2 = 0;
|
|
Hp10Rate1On = Hp10Rate2On = Hp10Rate1Off = Hp10Rate2Off = 0;
|
|
pThDose = &Hp10THDose2;
|
|
pThRate = &Hp10Rate2On;
|
|
pTHDoseWarning = &Hp10THDose1;
|
|
pTHRateWarning = &Hp10Rate1Off;
|
|
break;
|
|
}
|
|
|
|
for (int ix = 0; ix < th->NumberThresholds; ix++)
|
|
{
|
|
switch ((ThresholdId)th->Thresholds[ix].Id) {
|
|
case ThresholdId::Thres_DoseAlarm: if (pThDose != nullptr) *pThDose = th->Thresholds[ix].Value; break;
|
|
case ThresholdId::Thres_DoseWarning: if (pTHDoseWarning != nullptr) *pTHDoseWarning = th->Thresholds[ix].Value; break;
|
|
case ThresholdId::Thres_RateAlarm: if (pThRate != nullptr) *pThRate = th->Thresholds[ix].Value; break;
|
|
case ThresholdId::Thres_RateWarning: if (pTHRateWarning != nullptr) *pTHRateWarning = th->Thresholds[ix].Value; break;
|
|
}
|
|
}
|
|
}
|
|
void Epd3Base::Epd3U::encodeTreshold(Mk3AlarmThresholds_t* th)
|
|
{
|
|
//th.MeasId
|
|
float* pThDose, * pThRate, * pTHDoseWarning, * pTHRateWarning;
|
|
//Voorlopig
|
|
Hp07THDoseA = Hp07THDose * 0.8F;
|
|
Hp07RateAOn = Hp07RateOn * 0.8F;
|
|
// einde voorlopig
|
|
th->NumberThresholds = 4;
|
|
switch ((MeasurementId)th->MeasId) {
|
|
case MeasurementId::Meas_Hp07:
|
|
case MeasurementId::Meas_Hp10N:
|
|
pThDose = &Hp07THDose;
|
|
pTHDoseWarning = &Hp07THDoseA;
|
|
pThRate = &Hp07RateOn;
|
|
pTHRateWarning = &Hp07RateAOn;
|
|
RatePct[0].MeasId = th->MeasId;
|
|
RatePct[0].Value = 85; // (int)(Hp07RateOff * 100.0 / Hp07RateOn);
|
|
break;
|
|
case MeasurementId::Meas_Hp10:
|
|
case MeasurementId::Meas_Hp10G:
|
|
pThDose = &Hp10THDose2;
|
|
pThRate = &Hp10Rate2On;
|
|
pTHDoseWarning = &Hp10THDose1;
|
|
pTHRateWarning = &Hp10Rate1On;
|
|
RatePct[1].MeasId = th->MeasId;
|
|
RatePct[1].Value = 85; // (int)(Hp10Rate2Off * 100.0 / Hp10Rate2On);
|
|
break;
|
|
default:
|
|
pThDose = &Hp07THDose;
|
|
pTHDoseWarning = &Hp07THDoseA;
|
|
pThRate = &Hp07RateOn;
|
|
pTHRateWarning = &Hp07RateAOn;
|
|
}
|
|
|
|
th->Thresholds[0].Id = (uint16_t)ThresholdId::Thres_DoseAlarm;
|
|
th->Thresholds[0].Value = *pThDose;
|
|
th->Thresholds[1].Id = (uint16_t)ThresholdId::Thres_RateAlarm;
|
|
th->Thresholds[1].Value = *pThRate;
|
|
th->Thresholds[2].Id = (uint16_t)ThresholdId::Thres_DoseWarning;
|
|
th->Thresholds[2].Value = *pTHDoseWarning;
|
|
th->Thresholds[3].Id = (uint16_t)ThresholdId::Thres_RateWarning;
|
|
th->Thresholds[3].Value = *pTHRateWarning;
|
|
}
|
|
/// <summary>
|
|
/// HG, SG, BC, FB, BC, FB
|
|
/// </summary>
|
|
/// <param name="numdTresholds"></param>
|
|
void Epd3Base::Epd3U::decodedTresholds(int numdTresholds)
|
|
{
|
|
for (int ix = 0; ix < numdTresholds; ix++) {
|
|
switch ((CounterType)dTresholds[ix].type) {
|
|
case CounterType::Counter_Hg1: HG = dTresholds[ix].value; break;
|
|
case CounterType::Counter_Sg1: SG = dTresholds[ix].value; break;
|
|
case CounterType::Counter_Sg2: BC = dTresholds[ix].value; break;
|
|
case CounterType::Counter_Fb1: FB = dTresholds[ix].value; break;
|
|
case CounterType::Counter_An1: BC = dTresholds[ix].value; break; //AN-> BC
|
|
case CounterType::Counter_Fn2: FB = dTresholds[ix].value; break; //FN->FB
|
|
}
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// Read K1 = K2 = K3 = K4 = K4 = K6
|
|
/// </summary>
|
|
/// <returns></returns>
|
|
WORD Epd3Base::Epd3U::ReadCal()
|
|
{
|
|
int r = 0;
|
|
SetFunctionReturnValue(ReadSensitivities,0);
|
|
token = BeginReadSensitivities(epdComsHandle, nullptr, 0, nullptr);
|
|
r = CommitAndSetRV();
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r);
|
|
r = EndReadSensitivities(epdComsHandle, token, sensitivities, MaxSensitivities, &numSensitivities);
|
|
r = SetEndReturnValue(r);
|
|
if (r != 0) goto error;
|
|
decodeSensitivities(numSensitivities);
|
|
return r;
|
|
error:
|
|
Error = r;
|
|
return r;
|
|
}
|
|
/// <summary>
|
|
/// K1 .. K6, SG , BC ,FB , HG
|
|
/// </summary>
|
|
/// <returns>0 OK</returns>
|
|
WORD Epd3Base::Epd3U::ReadSensitivitiesAndTresholds()
|
|
{
|
|
int32_t r = 0;
|
|
if (Epd.Gen == EpdGeneration::Mk2) {
|
|
uint16_t HGSens10;
|
|
uint16_t SGSens10;
|
|
uint16_t HGSens07;
|
|
uint16_t SGSens07;
|
|
uint16_t FBSens07;
|
|
uint16_t BCSens07;
|
|
uint16_t SGthresh;
|
|
uint16_t BCthresh;
|
|
uint16_t FBthresh;
|
|
uint16_t HGthresh;
|
|
|
|
token = BeginReadCalibrationData_R2(epdComsHandle, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
r = EndReadCalibrationData_R2(epdComsHandle, token,
|
|
&HGSens10,
|
|
&SGSens10,
|
|
&HGSens07,
|
|
&SGSens07,
|
|
&FBSens07,
|
|
&BCSens07,
|
|
&SGthresh,
|
|
&BCthresh,
|
|
&FBthresh,
|
|
&HGthresh
|
|
);
|
|
K1 = HGSens10;
|
|
K2 = SGSens10;
|
|
K3 = HGSens07;
|
|
K4 = SGSens07;
|
|
K5 = FBSens07;
|
|
K6 = BCSens07;
|
|
SG = SGthresh;
|
|
BC = BCthresh;
|
|
FB = FBthresh;
|
|
HG = HGthresh;
|
|
}
|
|
else {
|
|
SetFunctionReturnValue(ReadDetectorThresholds,0);
|
|
token = BeginReadDetectorThresholds_R3(epdComsHandle, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
r = EndReadDetectorThresholds_R3(epdComsHandle, token, dTresholds, MaxTresholds, &numTresholds);
|
|
r = SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
decodedTresholds(numTresholds); // HG, SG, BC, FB, BC, FB
|
|
r = ReadCal();// K1 = K2 = K3 = K4 = K4 = K6
|
|
}
|
|
return r;
|
|
error:
|
|
return r;
|
|
}
|
|
|
|
/// <summary>
|
|
/// Doses, totDoses, Knocks + Resets , PeakRates, SensitivitiesAndTresholds: K1 .. K6, SG , BC ,FB , HG
|
|
/// </summary>
|
|
/// <returns>0 OK</returns>
|
|
WORD Epd3Base::Epd3U::ReadDoses()
|
|
{
|
|
int32_t r = 1;
|
|
eDosDose07Warning = eDosDose07Alarm = eDosDose10Warning = eDosDose10Alarm = eDosRate07Warning = eDosRate07Alarm = eDosRate10Warning = eDosRate10Alarm = eDosBatteryWarning = 0;
|
|
|
|
if (port == 0) {
|
|
Hp10Dose = Hp07Dose = Hp10Total = Hp07Total = 0.0;
|
|
Knocks = Resets = QualityData = 21;
|
|
Hp10Peak = Hp07Peak = 0.0;
|
|
Hp10Time = Hp07Time = 1000;
|
|
ErrorSource = ErrorReason = ErrorData = 0;
|
|
K1 = 1; K2 = 2; K3 = 3; K4 = 4; K5 = 5; K6 = 6;
|
|
SG = 7; BC = 8; FB = 9; HG = 10;
|
|
return r_OK;
|
|
}
|
|
|
|
numDoses = 0; utc = 0;
|
|
|
|
SetFunctionReturnValue(eFunctions::fReadDoses,0);
|
|
token = BeginReadDoses(epdComsHandle, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) r = EndReadDoses(epdComsHandle, token, doses, MaxDoses, &numDoses, &utc);
|
|
r = SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
decodeDoses(numDoses);
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadTotalDoses,0);
|
|
token = BeginReadTotalDoses(epdComsHandle, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) r = EndReadTotalDoses(epdComsHandle, token, totdoses, MaxDoses, &numtotDoses, &utc);
|
|
r = SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
decodetotDoses(numtotDoses);
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadQualityData,0);
|
|
token = BeginReadQualityData(epdComsHandle, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) r = EndReadQualityData(epdComsHandle, token, &quality);
|
|
r = SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
Knocks = quality.Knocks;
|
|
Resets = quality.PowerCycles;
|
|
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadPeakRates,0);
|
|
token = BeginReadPeakRates(epdComsHandle, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) r = EndReadPeakRates(epdComsHandle, token, peakRates, MaxPeakRates, &numRates);
|
|
r= SetEndReturnValue(r);
|
|
|
|
if (r != 0)
|
|
goto error;
|
|
decodePeakRates(numRates);
|
|
|
|
|
|
r = ReadSensitivitiesAndTresholds(); //K1 .. K6, SG , BC ,FB , HG
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
return r;
|
|
|
|
error:
|
|
Error = r;
|
|
return r;
|
|
}
|
|
/// <summary>
|
|
///
|
|
/// </summary>
|
|
/// <returns>0 success</returns>
|
|
int Epd3Base::Epd3U::ClearDoses()
|
|
{
|
|
//constexpr int maxbatch = 3;
|
|
int rv;
|
|
//int r[maxbatch];
|
|
//int s[maxbatch];
|
|
//int batchstep = 0;
|
|
SetFunctionReturnValue(eFunctions::ClearTotalDose,0);
|
|
token = BeginClearTotalDose(epdComsHandle, nullptr);
|
|
rv = CommitAndEnd2RV(EndClearTotalDose, token);
|
|
if (rv) goto error;
|
|
//batchstep = 1;
|
|
SetFunctionReturnValue(eFunctions::ClearDose,0);
|
|
token= BeginClearDose(epdComsHandle, nullptr);
|
|
rv = CommitAndEnd2RV(EndClearDose, token);
|
|
if (rv) goto error;
|
|
//batchstep = 2;
|
|
SetFunctionReturnValue(eFunctions::ClearPeakRates,0);
|
|
token= BeginClearPeakRates(epdComsHandle, nullptr);
|
|
rv = CommitAndEnd2RV(EndClearPeakRates, token);
|
|
if (rv) goto error;
|
|
|
|
//rv = CommitAndSetRV(s, maxbatch);
|
|
//batchstep = 0;
|
|
//r[batchstep] = End2RV(s[batchstep], EndClearTotalDose, btoken[batchstep]);
|
|
//batchstep = 1;
|
|
//r[batchstep] = End2RV(s[batchstep], EndClearDose, btoken[batchstep]);
|
|
//batchstep = 2;
|
|
//r[batchstep] = End2RV(s[batchstep], EndClearPeakRates, btoken[batchstep]);
|
|
|
|
//rv = r[0];
|
|
//for (int b = 1; !rv && b < maxbatch;++b) if (r[b]) rv = r[b];
|
|
error:
|
|
Error = rv;
|
|
return rv;
|
|
|
|
}
|
|
int Epd3Base::Epd3U::ClearAlarms()
|
|
{
|
|
constexpr int maxbatch = 2;
|
|
int rv;
|
|
int r[maxbatch];
|
|
int s[maxbatch];
|
|
int batchstep = 0;
|
|
|
|
s[batchstep] = SetFunctionReturnValue(eFunctions::ClearFaultStatus,0);
|
|
btoken[batchstep]= BeginClearFaultStatus(epdComsHandle, nullptr);
|
|
batchstep = 1;
|
|
s[batchstep] = SetFunctionReturnValue(eFunctions::ClearLatchedAlarms, 0);
|
|
btoken[batchstep] = BeginClearLatchedAlarms(epdComsHandle, nullptr);
|
|
|
|
rv = CommitAndSetRV(s, maxbatch);
|
|
|
|
batchstep = 0;
|
|
r[batchstep] = End2RV(s[batchstep],EndClearFaultStatus, btoken[batchstep]);
|
|
batchstep = 1;
|
|
r[batchstep] = End2RV(s[batchstep],EndClearLatchedAlarms, btoken[batchstep]);
|
|
|
|
rv = r[0];
|
|
for (int b = 1; !rv && b < maxbatch; ++b) if (r[b]) rv = r[b];
|
|
Error = rv;
|
|
return rv;
|
|
}
|
|
WORD Epd3Base::Epd3U::PrepareForIssue()
|
|
{
|
|
int rv = 0;
|
|
int step = 0;
|
|
if (port == 0) return 0;
|
|
|
|
|
|
/*if (DetectorsOn) {
|
|
token = BeginEpdOnOff(epdComsHandle, 0, nullptr);
|
|
rv = Commit3(epdComsHandle);
|
|
if (!rv) rv = EndEpdOnOff(epdComsHandle, token);
|
|
rv = ReOpenDev();
|
|
}
|
|
if (rv != 0)
|
|
goto error;*/
|
|
|
|
/* gebeurt bij clearalrms
|
|
SetFunctionReturnValue(eFunctions::ClearLatchedAlarms,0);
|
|
token = BeginEpdOnOff(epdComsHandle, 1, nullptr);
|
|
rv = CommitAndEnd2RV(EndEpdOnOff, token);
|
|
*/
|
|
step = 2;
|
|
if (WriteConfig32) {
|
|
rv = WriteConfig();
|
|
if (rv != 0)
|
|
goto error;
|
|
}
|
|
|
|
step = 3;
|
|
if (!isConnected)
|
|
rv = ReOpenDev();
|
|
|
|
step = 5;
|
|
rv = ClearAlarms();
|
|
if (rv != 0)
|
|
goto error;
|
|
|
|
step = 4;
|
|
rv = ClearDoses();
|
|
if (rv != 0)
|
|
goto error;
|
|
|
|
OutputDebugStringA("**** After clear ****\n");
|
|
Disconnect(epdComsHandle);
|
|
Sleep(SleepAfterClear);
|
|
|
|
return rv;
|
|
|
|
error:
|
|
DebugWrite("**** After clear step %d error %d ****\n", step, rv);
|
|
|
|
ErrorStep = step;
|
|
Error = rv;
|
|
return rv;
|
|
}
|
|
WORD Epd3Base::Epd3U::ReadAlarmConfig() {
|
|
//Alleen MK3 ? leeg bij MK2
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadAlarmConfiguration,0);
|
|
token = BeginReadAlarmConfiguration(epdComsHandle, nullptr, 0, nullptr);
|
|
int32_t r = CommitAndSetRV();
|
|
if (!r) { r = EndReadAlarmConfiguration(epdComsHandle, token, alarmConfig, MaxAlarmConfig, &numAlarm); SetEndReturnValue(r); }
|
|
return numAlarm;
|
|
}
|
|
WORD Epd3Base::Epd3U::ReadAlarmTresholds() {
|
|
//Alleen MK3 ? leeg bij MK2
|
|
bool isNeutron = (EpdType == EpdTypes::Mk2Neutron || EpdType == EpdTypes::Mk3Neutron);
|
|
uint8_t measID;
|
|
uint32_t r;
|
|
|
|
SetResponseTimeout(epdComsHandle, ResponseTimeout);
|
|
|
|
if (isNeutron) measID = (uint8_t)MeasurementId::Meas_Hp10N; else measID = (uint8_t)MeasurementId::Meas_Hp07;
|
|
hp07tresholds.MeasId = measID;
|
|
SetFunctionReturnValue(eFunctions::ReadAlarmThresholds,0);
|
|
token = BeginReadAlarmThresholds(epdComsHandle, (uint8_t)hp07tresholds.MeasId, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) { r = EndReadAlarmThresholds(epdComsHandle, token, &hp07tresholds); r = SetEndReturnValue(r); }
|
|
decodeTreshold(&hp07tresholds);
|
|
|
|
if (isNeutron) measID = (uint8_t)MeasurementId::Meas_Hp10G; else measID = (uint8_t)MeasurementId::Meas_Hp10;
|
|
hp10tresholds.MeasId = measID;
|
|
SetFunctionReturnValue(eFunctions::ReadAlarmThresholds,0);
|
|
token = BeginReadAlarmThresholds(epdComsHandle, (uint8_t)hp10tresholds.MeasId, nullptr, 0, nullptr);
|
|
r = Commit3(epdComsHandle);
|
|
SetCommitReturnValue(r);
|
|
if (!r) { r = EndReadAlarmThresholds(epdComsHandle, token, &hp10tresholds); r= SetEndReturnValue(r); }
|
|
decodeTreshold(&hp10tresholds);
|
|
|
|
return r;
|
|
}
|
|
WORD Epd3Base::Epd3U::WriteAlarmTresholds() {
|
|
//Alleen MK3 ? leeg bij MK2
|
|
uint32_t r;
|
|
|
|
bool isNeutron = (EpdType == EpdTypes::Mk2Neutron || EpdType == EpdTypes::Mk3Neutron);
|
|
uint8_t measID;
|
|
|
|
if (isNeutron) measID = (uint8_t)MeasurementId::Meas_Hp10G; else measID = (uint8_t)MeasurementId::Meas_Hp10;
|
|
hp10tresholds.MeasId = measID;
|
|
encodeTreshold(&hp10tresholds);
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteAlarmThresholds,0);
|
|
token = BeginWriteAlarmThresholds(epdComsHandle, (uint8_t)hp10tresholds.MeasId, (uint8_t)hp10tresholds.NumberThresholds, hp10tresholds.Thresholds, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteAlarmThresholds, token);
|
|
if (r != 0) goto error;
|
|
|
|
|
|
if (isNeutron) measID = (uint8_t)MeasurementId::Meas_Hp10N; else measID = (uint8_t)MeasurementId::Meas_Hp07;
|
|
hp07tresholds.MeasId = measID;
|
|
encodeTreshold(&hp07tresholds);
|
|
hp07tresholds.NumberThresholds = 4;
|
|
SetFunctionReturnValue(eFunctions::WriteAlarmThresholds,0);
|
|
token = BeginWriteAlarmThresholds(epdComsHandle, (uint8_t)hp07tresholds.MeasId, (uint8_t)hp07tresholds.NumberThresholds, hp07tresholds.Thresholds, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteAlarmThresholds, token);
|
|
if (r != 0) goto error;
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteRateOffPercentage,0);
|
|
token = BeginWriteRateOffPercentage(epdComsHandle, RatePct, 2, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteRateOffPercentage, token);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
return r;
|
|
|
|
error:
|
|
return r;
|
|
|
|
}
|
|
WORD Epd3Base::Epd3U::DeIssue()
|
|
{
|
|
int r = 1;
|
|
|
|
if (port == 0) return 0;
|
|
if (CurrentDeviceID == 0) return 0;
|
|
|
|
if (EPDIssued)
|
|
{
|
|
#if DeissueWithClear
|
|
ErrorStep = 2;
|
|
r = ClearDoses();
|
|
ErrorStep = 1;
|
|
r = ClearAlarms();
|
|
//needed after clear alarms
|
|
Sleep(2000);
|
|
#endif
|
|
SetFunctionReturnValue(eFunctions::DeissueEPD, 0);
|
|
token = BeginDeissueEPD(epdComsHandle, nullptr);
|
|
r = CommitAndEnd2RV(EndDeissueEPD, token);
|
|
Sleep(100);
|
|
}
|
|
|
|
SetFunctionReturnValue(eFunctions::EpdOnOff,0);
|
|
token = BeginEpdOnOff(epdComsHandle, 0, nullptr);
|
|
r = CommitAndEnd2RV(EndEpdOnOff, token);
|
|
Sleep(100);
|
|
|
|
if (r) goto error;
|
|
return r;
|
|
|
|
error:
|
|
|
|
Error = r;
|
|
return r;
|
|
}
|
|
WORD Epd3Base::Epd3U::WriteWearer() {
|
|
|
|
int32_t r = 0;
|
|
int step = 0;
|
|
|
|
SetFunctionReturnValue(eFunctions::SetBaselineCounters,0);
|
|
token = BeginSetBaselineCounters(epdComsHandle, nullptr);
|
|
r = CommitAndEnd2RV(EndSetBaselineCounters, token);
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r); r = EndSetBaselineCounters(epdComsHandle, token); SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
IdString_t mk3WearerID;
|
|
//Mk2 EPDs only support Name and Primary ID
|
|
|
|
mk3WearerID.IdType = (uint16_t)WearerIdType::WearerId_Name;
|
|
mk3WearerID.Length = 23;
|
|
memcpy(mk3WearerID.Utf8String, WearerName, 23);
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteWearerId,0);
|
|
token = BeginWriteWearerId(epdComsHandle, mk3WearerID, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteWearerId, token);
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r); r = EndWriteWearerId(epdComsHandle, token); SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
mk3WearerID.IdType = (uint16_t)WearerIdType::WearerId_Primary;
|
|
mk3WearerID.Length = 13;
|
|
memcpy(mk3WearerID.Utf8String, WearerID, 13);
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteWearerId,0);
|
|
token = BeginWriteWearerId(epdComsHandle, mk3WearerID, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteWearerId, token);
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r); r = EndWriteWearerId(epdComsHandle, token); SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
return r;
|
|
|
|
error:
|
|
|
|
Error = r;
|
|
return r;
|
|
}
|
|
/// <summary>
|
|
///
|
|
/// </summary>
|
|
/// <returns>0 Success</returns>
|
|
|
|
WORD Epd3Base::Epd3U::Issue(bool PrepareDone) //normaal is preparedone=tru
|
|
{
|
|
int r = 0;
|
|
int step = 0;
|
|
int tries = 0;
|
|
UINT16 Control = 0;
|
|
if (port == 0) return r;
|
|
|
|
r = 0;
|
|
if (!PrepareDone) {
|
|
r = PrepareForIssue();
|
|
if (r) goto error;
|
|
}
|
|
|
|
step = 1;
|
|
if (!isConnected) r = ReOpenDev();
|
|
if (r) goto error;
|
|
|
|
step = 4;
|
|
//EPDIssued
|
|
//if (!DetectorsOn) {
|
|
SetFunctionReturnValue(eFunctions::EpdOnOff, 0);
|
|
token = BeginEpdOnOff(epdComsHandle, 1, nullptr);
|
|
r = CommitAndEnd2RV(EndEpdOnOff, token);
|
|
|
|
#ifdef ProtectSession
|
|
if (isMK3) {
|
|
Control = 1; // EndSessionControl;
|
|
//SetFunctionReturnValue(EnableProtectedSession, 1);
|
|
//token = BeginEnableProtectedSession(epdComsHandle, 1, nullptr);
|
|
//r = CommitAndEnd2RV(EndEnableProtectedSession, token);
|
|
//if (r != 0) goto error;
|
|
}
|
|
#else
|
|
Control = 0;
|
|
#endif
|
|
|
|
step = 2;
|
|
r = WriteAlarmTresholds();
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
step = 3;
|
|
r = WriteWearer();
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
tries = 1;
|
|
SetFunctionReturnValue(eFunctions::IssueEPD,0);
|
|
token = BeginIssueEPD(epdComsHandle, nullptr);
|
|
r = CommitAndEnd2RV(EndIssueEPD, token);
|
|
|
|
if (r != 0) {
|
|
tries++;
|
|
if (r == r_ErrorNotConnected) ReOpenDev();
|
|
Sleep(500);
|
|
SetFunctionReturnValue(eFunctions::IssueEPD,0);
|
|
token = BeginIssueEPD(epdComsHandle, nullptr);
|
|
r = CommitAndEnd2RV(EndIssueEPD, token);
|
|
}
|
|
if (r)
|
|
goto error;
|
|
EPDIssued = 1;
|
|
|
|
|
|
step = 6;
|
|
if (isMK3) {
|
|
r = DisCon(Control); //stops protected session if control is EndSessionCOntrol
|
|
}
|
|
|
|
step = 7;
|
|
return r;
|
|
|
|
error:
|
|
ErrorStep = step;
|
|
Error = r;
|
|
return r;
|
|
}
|
|
|
|
WORD Epd3Base::Epd3U::EPDReadExtraStatus()
|
|
{
|
|
if (port == 0) return 1;
|
|
uint32_t r;
|
|
//byBatADC = bySupplyADC = 0;
|
|
/*CommitRV = ReadA2ConfigStatus(
|
|
&byBatADC,
|
|
&bySupplyADC,
|
|
&byStatus3,
|
|
&byStatus4);
|
|
if (CommitRV == 1) CommitRV = Commit3();*/
|
|
|
|
SetFunctionReturnValue(eFunctions::ReadBaselineCounts,0);
|
|
token = BeginReadBaselineCounts(epdComsHandle, nullptr);
|
|
r = CommitAndSetRV();// Commit3(epdComsHandle); SetCommitReturnValue(r);
|
|
if (!r) r = EndReadBaselineCounts(epdComsHandle, token, Counts, 10, &utc, &countsRead);
|
|
r = SetEndReturnValue(r);
|
|
if (!r) decodeBaseCounters(countsRead);
|
|
//if (CommitRV == 1) CommitRV = ReadCounts(&D1, &D2, &D3, &D4, &CountsClock);
|
|
//if (CommitRV == 1) CommitRV = Commit3();
|
|
//if (CommitRV == 1) CommitRV = ReadBaseCounts(&BaseD1, &BaseD2, &BaseD3, &BaseD4, &BaseCountsClock);
|
|
//if (CommitRV == 1) CommitRV = Commit3();
|
|
return r;
|
|
}
|
|
|
|
WORD Epd3Base::Epd3U::WriteCal()
|
|
{
|
|
uint32_t r = 0;
|
|
if (port == 0) return 0;
|
|
|
|
if (K6 > 2000)
|
|
{
|
|
r = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (EpdType == EpdTypes::Mk2Neutron)
|
|
{
|
|
Password = 9;
|
|
|
|
SetFunctionReturnValue(eFunctions::MfrLogin_R2,0);
|
|
token = BeginMfrLogin_R2(epdComsHandle, Password, nullptr);
|
|
uint32_t r = CommitAndEnd2RV(EndMfrLogin_R2,token);
|
|
//Commit3(epdComsHandle); SetCommitReturnValue(r); if (!r ) r = EndMfrLogin_R2(epdComsHandle, token); SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteSensitivities_R2,0);
|
|
token = BeginWriteSensitivities_R2(epdComsHandle, nullptr, (uint16_t)K1, (uint16_t)K2, (uint16_t)K3, (uint16_t)K4, (uint16_t)K5, (uint16_t)K6);
|
|
r = CommitAndEnd2RV(EndWriteSensitivities_R2, token);
|
|
//r = Commit3(epdComsHandle); SetCommitReturnValue(r); r = EndWriteSensitivities_R2(epdComsHandle, token); SetEndReturnValue(r);
|
|
if (r != 0)
|
|
goto error;
|
|
}
|
|
return r;
|
|
error:
|
|
return r;
|
|
}
|
|
|
|
//main get dose function
|
|
//close com at end
|
|
int Epd3Base::Epd3U::GetAll(bool Closeconnection)
|
|
{
|
|
int rv = 0, step = 1;
|
|
rv = ReadDoses();
|
|
step=2;
|
|
if (!rv) rv = ReadAlarmTresholds();
|
|
if (Closeconnection) EndCom(isConnected );
|
|
return rv;
|
|
}
|
|
|
|
// Main entry point deissue for MK3
|
|
// close com at then
|
|
int Epd3Base::Epd3U::GetAllDeissue(bool reconnect)
|
|
{
|
|
int rv = 0;
|
|
int step = 0;
|
|
|
|
ResetStepReturnValues();
|
|
|
|
step = 1;
|
|
rv = ReadDoses(); //0 = success
|
|
if (rv) goto error;
|
|
//rv = ReadAlarmTresholds(); //0 = success
|
|
|
|
step = 2;
|
|
rv = EPDReadExtraStatus();
|
|
if (rv) goto error;
|
|
|
|
step = 3;
|
|
rv = DeIssue(); //does close
|
|
|
|
EndCom(isConnected);
|
|
if (rv) goto error;
|
|
|
|
return rv;
|
|
|
|
error:
|
|
Error = rv;
|
|
ErrorStep = step;
|
|
return rv;
|
|
}
|
|
|
|
// main issue routine
|
|
// cloise com at end
|
|
int Epd3Base::Epd3U::IssueAndCheck(float gain, float ChirpRate)
|
|
{
|
|
int rv = 0;
|
|
int step = 0;
|
|
DWORD wrv = 0;
|
|
int rv1 = -1, rv2 = -1;
|
|
|
|
ResetStepReturnValues();
|
|
|
|
if (!isConnected) rv = ReOpenDev();
|
|
if (rv) goto error;
|
|
|
|
step = 1;
|
|
rv = SetTime();
|
|
//synctime
|
|
|
|
OutputDebugStringW(L"**** Prepare ****\n");
|
|
step = 2;
|
|
rv = PrepareForIssue(); //Set epd on, clear doses and alarms
|
|
if (rv) goto error;
|
|
|
|
rv = ReOpenDev();
|
|
rv = ReadStatusOnly();
|
|
wrv= WaitForSingleObject(hCompletion, 2000);
|
|
if (wrv == WAIT_OBJECT_0) rv = 0;
|
|
else if (wrv == WAIT_TIMEOUT) {
|
|
rv = 1;
|
|
}
|
|
|
|
//rv1 = StepReturnValues[CurrentStep][1];
|
|
//rv2 = StepReturnValues[CurrentStep][2];
|
|
|
|
step = 3;
|
|
if (isNG) {
|
|
step = 1;
|
|
float kx = gain;
|
|
rv = ReadCal();
|
|
if (rv != 0 || K6 != 1310) { rv = 1; goto error; }
|
|
if (K3 != kx || K4 != kx)
|
|
{
|
|
step = 2;
|
|
K3 = K4 = kx;
|
|
rv = WriteCal();
|
|
if (rv != 0) goto error;
|
|
}
|
|
}
|
|
|
|
step = 3;
|
|
if (!isConnected) rv = ReOpenDev();
|
|
rv = SetChirp(ChirpRate);
|
|
if (rv == r_ErrorNotConnected)
|
|
{
|
|
rv = ReOpenDev();
|
|
rv = SetChirp(ChirpRate);
|
|
}
|
|
if (rv) goto error;
|
|
|
|
step = 5;
|
|
rv = Issue(true); // data already loaded
|
|
|
|
EndCom(isConnected);
|
|
if (rv) goto error;
|
|
|
|
return rv;
|
|
|
|
error:
|
|
|
|
Error = rv;
|
|
ErrorStep = step;
|
|
return rv;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::WriteConfig(void)
|
|
{
|
|
if (port == 0 || WriteConfig32 == 0) return 1;
|
|
int32_t r = 0;
|
|
ECLen = 32;
|
|
|
|
DebugWrite("**** WriteCfg v %d.%d ****\n", HardVersion, HardVersionMinor);
|
|
// Become admin
|
|
SetFunctionReturnValue(eFunctions::WriteAccessLevelAdmin,0);
|
|
token = BeginWriteAccessLevel(epdComsHandle, AccessLevel_t::Admin, EC, ECLen, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteAccessLevel,token);
|
|
if (!r) {
|
|
displayIds = new QuickAccessDisplay_t[6]{
|
|
{ 0,0x0021 },
|
|
{ 1,0x0022 },
|
|
{ 2,0x0031 },
|
|
{ 3,0x0032 },
|
|
{ 4,0x0051 },
|
|
{ 5,0x0062 }
|
|
};
|
|
|
|
numDisplays = 6;
|
|
SetFunctionReturnValue(eFunctions::WriteQuickAccessDisplays_R3,1);
|
|
token = BeginWriteQuickAccessDisplays_R3(epdComsHandle, displayIds, numDisplays, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteQuickAccessDisplays_R3, token);
|
|
}
|
|
if (!r) {
|
|
//Unmanaged%20HtmlFiles/_display_ids.html
|
|
numItems = 9;
|
|
if (HardVersionMinor > 0) {
|
|
enables = new DisplayAttributeMap_t[9]{
|
|
{ 0,0x3FFF,0xFFFF },
|
|
{ 1,0x3FFF,0xFF01 }, //{ 1,0x0FFF,0xFFE1 }
|
|
{ 2,0x3FFF,0xFE0F },
|
|
{ 3,0x3FFF,0xFE0F },
|
|
{ 4,0x3FFF,0xFE01 },
|
|
{ 5,0x3FFF,0xFF0B },
|
|
{ 6,0x3FFF,0xFFF9 },
|
|
{ 7,0x3FFF,0xFFD3 },
|
|
{ 8,0x3FFF,0xFFFF }
|
|
};
|
|
}
|
|
else {
|
|
enables = new DisplayAttributeMap_t[9]{
|
|
{ 0,0x0FFF, 0xFFFF },
|
|
{ 1,0x0FFF,0xFFE1 },
|
|
{ 2,0x0FFF,0xFE07 },
|
|
{ 3,0x0FFF,0xFE07 },
|
|
{ 4,0x0FFF,0xFE01 },
|
|
{ 5,0x0FFF,0xFF0B },
|
|
{ 6,0x0FFF,0xFFF9 },
|
|
{ 7,0x0FFF,0xFFD3 },
|
|
{ 8,0x0FFF,0xFFFF }
|
|
};
|
|
}
|
|
|
|
// 0x1 Operation Menu Back /0x2 On / Off 0x4 Clear Dose 0x8 Toggle Telemtry 0x10 Responder Trigger
|
|
// 1 0 0 0 0
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteDisplayEnables_R3,1);
|
|
token = BeginWriteDisplayEnables_R3(epdComsHandle, enables, numItems, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteDisplayEnables_R3, token);
|
|
}
|
|
if (!r) {
|
|
uint8_t numMenus = 9;
|
|
uint16_t permissions[9] = {
|
|
0x0000 ,
|
|
0x0016 ,
|
|
0x0000 ,
|
|
0x0000 ,
|
|
0x0000 ,
|
|
0x0000 ,
|
|
0x0000 ,
|
|
0x0004 ,
|
|
0x0000
|
|
};
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteDisplayEnablePermissions_R3,1);
|
|
token = BeginWriteDisplayEnablePermissions_R3(epdComsHandle, AccessLevel_t::Admin, permissions, numDisplays, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteDisplayEnablePermissions_R3, token);
|
|
}
|
|
if (!r) {
|
|
//AlarmConfiguration
|
|
uint8_t alarmConfigLen = 14;
|
|
alarmConfigIds = new AlarmConfig_t[14]{
|
|
{ (AlarmIds)6,0,0x0000,0x1884,60 },
|
|
{ (AlarmIds)8,0,0x0000,0x9884,60 },
|
|
{ (AlarmIds)5,0,0x0000,0x9CA4,60 },
|
|
{ (AlarmIds)4,0,0x0000,0x9CC7,60 },
|
|
{ (AlarmIds)9,0,0x0000,0x9CA5,60 },
|
|
{ (AlarmIds)7,0,0x0000,0x1884,60 },
|
|
{ (AlarmIds)0,0,0x0000,0x9CC1,60 },
|
|
{ (AlarmIds)1,0,0x0000,0x1884,60 },
|
|
{ (AlarmIds)2,0,0x0000,0x9CC7,60 },
|
|
{ (AlarmIds)3,0,0x0000,0x1885,60 },
|
|
{ (AlarmIds)0,1,0x0000,0x9CC1,60 },
|
|
{ (AlarmIds)1,1,0x0000,0x1884,60 },
|
|
{ (AlarmIds)2,1,0x0000,0x9CC7,60 },
|
|
{ (AlarmIds)3,1,0x0000,0x1885,60 }
|
|
};
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteAlarmConfiguration_R3,1);
|
|
token = BeginWriteAlarmConfiguration_R3(epdComsHandle, alarmConfigIds, alarmConfigLen, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteAlarmConfiguration_R3, token);
|
|
}
|
|
|
|
//constexpr int maxbatch= 2;
|
|
//int s[maxbatch];
|
|
//int rv[maxbatch];
|
|
//int batchstep;
|
|
|
|
if (!r) {
|
|
//OffModeDisplay
|
|
dutyCycle = (OffModeDutyCycle)0;
|
|
offModeDispId = (OffModeDisplayId_t)1;
|
|
SetFunctionReturnValue(eFunctions::WriteOffModeDisplay_R3,1);
|
|
token = BeginWriteOffModeDisplay_R3(epdComsHandle, dutyCycle, offModeDispId, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteOffModeDisplay_R3, token);
|
|
|
|
uint8_t OnOfenabled = 0;
|
|
SetFunctionReturnValue(eFunctions::WriteSwitchOnFromButton_R3, 0);
|
|
token = BeginWriteSwitchOnFromButton_R3(epdComsHandle, OnOfenabled, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteSwitchOnFromButton_R3, token);
|
|
|
|
SetFunctionReturnValue(eFunctions::WriteAccessLevelOpen, 0);
|
|
token = BeginWriteAccessLevel(epdComsHandle, AccessLevel_t::Open,nullptr,0, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteAccessLevel, token);
|
|
|
|
Sleep(200);
|
|
r = DisconnectAndConnect();
|
|
|
|
Error = r;
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
int Epd3Base::Epd3U::SetChirp(float Sensitivity)
|
|
{
|
|
uint32_t r = 1;
|
|
uint8_t enable = 0;
|
|
|
|
if (Sensitivity > 0.001F) {
|
|
enable = 1;
|
|
SetFunctionReturnValue(eFunctions::WriteChirpSensitivity,0);
|
|
token = BeginWriteChirpSensitivity(epdComsHandle, Sensitivity, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteChirpSensitivity , token);
|
|
}
|
|
if (r) goto error;
|
|
|
|
if (!r) {
|
|
SetFunctionReturnValue(eFunctions::WriteChirpEnable_R3,0);
|
|
token = BeginWriteChirpEnable_R3(epdComsHandle, enable, nullptr);
|
|
r = CommitAndEnd2RV(EndWriteChirpEnable_R3, token);
|
|
}
|
|
if (r) goto error;
|
|
|
|
return r;
|
|
error:
|
|
return r;
|
|
}
|