void Slave::HandleEnableUnsolicited(const APDU& arRequest, bool aIsEnable)
{
mResponse.Set(FC_RESPONSE);
if (mConfig.mDisableUnsol) {
mRspIIN.SetFuncNotSupported(true);
}
else {
if (aIsEnable) {
this->mDeferredUnsol = true;
}
for (HeaderReadIterator hdr = arRequest.BeginRead(); !hdr.IsEnd(); ++hdr) {
switch (MACRO_DNP_RADIX(hdr->GetGroup(), hdr->GetVariation())) {
case (MACRO_DNP_RADIX(60, 2)):
mConfig.mUnsolMask.class1 = aIsEnable;
break;
case (MACRO_DNP_RADIX(60, 3)):
mConfig.mUnsolMask.class2 = aIsEnable;
break;
case (MACRO_DNP_RADIX(60, 4)):
mConfig.mUnsolMask.class3 = aIsEnable;
break;
default:
mRspIIN.SetFuncNotSupported(true);
LOG_BLOCK(LEV_WARNING, "Cannot enable/disable unsol for " << hdr->GetBaseObject()->Name());
break;
}
}
}
}
TaskResult TimeSync::_OnFinalResponse(const APDU& arAPDU)
{
if(mDelay < 0) {
ptime now = mpTimeSrc->GetUTC();
HeaderReadIterator hri = arAPDU.BeginRead();
if(hri.Count() != 1) {
LOG_BLOCK(LEV_WARNING, "DelayMeas response w/ unexcpected header count");
return TR_FAIL;
}
if(!hri->GetBaseObject()->Equals(Group52Var2::Inst())) {
LOG_BLOCK(LEV_WARNING, "DelayMeas response w/ unexpected object: " << hri->GetBaseObject()->Name());
return TR_FAIL;
}
ObjectReadIterator ori = hri.BeginRead();
if(ori.Count() != 1) {
LOG_BLOCK(LEV_WARNING, "DelayMeas got more than 1 object in response");
return TR_FAIL;
}
millis_t send_rcv_time = (now - mStart).total_milliseconds();
millis_t rtu_turn_around = Group52Var2::Inst()->mTime.Get(*ori);
// The later shouldn't happen, but could cause a negative delay which would
// result in a weird time setting
mDelay = (send_rcv_time >= rtu_turn_around) ? (send_rcv_time - rtu_turn_around)/2 : 0;
return TR_CONTINUE;
}
else {
return TR_SUCCESS;
}
}
