private static void ResetProtocolKnowledgeForPort(byte hubId, byte portId, ProtocolKnowledge knowledge)
{
var port = knowledge.Port(hubId, portId);
port.IsDeviceConnected = false;
port.IOTypeId = DeviceType.Unknown;
port.HardwareRevision = new Version("0.0.0.0");
port.SoftwareRevision = new Version("0.0.0.0");
port.OutputCapability = false;
port.InputCapability = false;
port.LogicalCombinableCapability = false;
port.LogicalSynchronizableCapability = false;
port.Modes.Clear();
port.ModeCombinations = Array.Empty <ushort>();
port.UsedCombinationIndex = 0;
port.MultiUpdateEnabled = false;
port.ConfiguredModeDataSetIndex = Array.Empty <int>();
}
private static void AddCachePortAndPortModeInformation(DeviceType type, Version hardwareRevision, Version softwareRevision, HubInfo hub, PortInfo port, ProtocolKnowledge knowledge, IDeviceFactory deviceFactory)
{
var device = deviceFactory.Create(type);
if (device is not null)
{
foreach (var message in device.GetStaticPortInfoMessages(hardwareRevision, softwareRevision, hub.SystemType).Select(b => MessageEncoder.Decode(b, null)))
{
var messageToProcess = message;
switch (messageToProcess)
{
case PortModeInformationMessage pmim:
messageToProcess = pmim with
{
HubId = port.HubId,
PortId = port.PortId,
};
break;
case PortInformationMessage pim:
messageToProcess = pim with
{
HubId = port.HubId,
PortId = port.PortId,
};
break;
}
ApplyStaticProtocolKnowledge(messageToProcess, knowledge);
if (messageToProcess is PortModeInformationMessage pmim2 && pmim2.InformationType == PortModeInformationType.Name)
{
device.ExtendPortMode(knowledge.PortMode(pmim2.HubId, pmim2.PortId, pmim2.Mode));
}
}
}
}
public static bool ApplyStaticProtocolKnowledge(LegoWirelessMessage message, ProtocolKnowledge knowledge)
{
var applicableMessage = true;
PortInfo port;
PortModeInfo mode;
switch (message)
{
case PortInformationForModeInfoMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
port.OutputCapability = msg.OutputCapability;
port.InputCapability = msg.InputCapability;
port.LogicalCombinableCapability = msg.LogicalCombinableCapability;
port.LogicalSynchronizableCapability = msg.LogicalSynchronizableCapability;
foreach (var modeInfo in Enumerable.Range(0, msg.TotalModeCount).Select(modeIndex => new PortModeInfo()
{
HubId = port.HubId,
PortId = msg.PortId,
ModeIndex = (byte)modeIndex,
IsInput = ((1 << modeIndex) & msg.InputModes) > 0,
IsOutput = ((1 << modeIndex) & msg.OutputModes) > 0
}))
{
port.Modes.TryAdd(modeInfo.ModeIndex, modeInfo);
}
break;
case PortInformationForPossibleModeCombinationsMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
port.ModeCombinations = msg.ModeCombinations;
break;
case PortModeInformationForNameMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.Name = msg.Name;
break;
case PortModeInformationForRawMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.RawMin = msg.RawMin;
mode.RawMax = msg.RawMax;
break;
case PortModeInformationForPctMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.PctMin = msg.PctMin;
mode.PctMax = msg.PctMax;
break;
case PortModeInformationForSIMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.SIMin = msg.SIMin;
mode.SIMax = msg.SIMax;
break;
case PortModeInformationForSymbolMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.Symbol = msg.Symbol;
break;
case PortModeInformationForMappingMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.InputSupportsNull = msg.InputSupportsNull;
mode.InputSupportFunctionalMapping20 = msg.InputSupportFunctionalMapping20;
mode.InputAbsolute = msg.InputAbsolute;
mode.InputRelative = msg.InputRelative;
mode.InputDiscrete = msg.InputDiscrete;
mode.OutputSupportsNull = msg.OutputSupportsNull;
mode.OutputSupportFunctionalMapping20 = msg.OutputSupportFunctionalMapping20;
mode.OutputAbsolute = msg.OutputAbsolute;
mode.OutputRelative = msg.OutputRelative;
mode.OutputDiscrete = msg.OutputDiscrete;
break;
case PortModeInformationForValueFormatMessage msg:
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.Mode);
mode.NumberOfDatasets = msg.NumberOfDatasets;
mode.DatasetType = msg.DatasetType;
mode.TotalFigures = msg.TotalFigures;
mode.Decimals = msg.Decimals;
break;
default:
applicableMessage = false;
break;
}
return(applicableMessage);
}
public static Task ApplyDynamicProtocolKnowledge(LegoWirelessMessage message, ProtocolKnowledge knowledge, IDeviceFactory deviceFactory)
{
HubInfo hub;
PortInfo port;
PortModeInfo mode;
switch (message)
{
case HubPropertyMessage <SystemType> msg when msg.Property == HubProperty.SystemTypeId:
hub = knowledge.Hub(msg.HubId);
hub.SystemType = msg.Payload;
break;
case HubAttachedIOForAttachedDeviceMessage msg:
hub = knowledge.Hub(msg.HubId);
port = knowledge.Port(msg.HubId, msg.PortId);
ResetProtocolKnowledgeForPort(msg.HubId, port.PortId, knowledge);
port.IsDeviceConnected = true;
port.IOTypeId = msg.IOTypeId;
port.HardwareRevision = msg.HardwareRevision;
port.SoftwareRevision = msg.SoftwareRevision;
AddCachePortAndPortModeInformation(msg.IOTypeId, msg.HardwareRevision, msg.SoftwareRevision, hub, port, knowledge, deviceFactory);
break;
case HubAttachedIOForDetachedDeviceMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
ResetProtocolKnowledgeForPort(msg.HubId, port.PortId, knowledge);
port.IsDeviceConnected = false;
break;
case HubAttachedIOForAttachedVirtualDeviceMessage msg:
hub = knowledge.Hub(msg.HubId);
port = knowledge.Port(msg.HubId, msg.PortId);
var partOfVirtual = knowledge.Port(msg.HubId, msg.PortAId);
ResetProtocolKnowledgeForPort(msg.HubId, port.PortId, knowledge);
port.IsDeviceConnected = true;
port.IOTypeId = msg.IOTypeId;
port.HardwareRevision = partOfVirtual.HardwareRevision;
port.SoftwareRevision = partOfVirtual.SoftwareRevision;
AddCachePortAndPortModeInformation(msg.IOTypeId, partOfVirtual.HardwareRevision, partOfVirtual.SoftwareRevision, hub, port, knowledge, deviceFactory);
port.IsVirtual = true;
port.PortAId = msg.PortAId;
port.PortBId = msg.PortBId;
break;
case PortInputFormatSingleMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
mode = knowledge.PortMode(msg.HubId, msg.PortId, msg.ModeIndex);
port.LastFormattedPortMode = msg.ModeIndex;
mode.DeltaInterval = msg.DeltaInterval;
mode.NotificationEnabled = msg.NotificationEnabled;
break;
case PortInputFormatSetupCombinedModeForSetModeDataSetMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
port.RequestedCombinedModeDataSets = msg.ModeDataSets;
break;
case PortInputFormatCombinedModeMessage msg:
port = knowledge.Port(msg.HubId, msg.PortId);
port.UsedCombinationIndex = msg.UsedCombinationIndex;
port.MultiUpdateEnabled = msg.MultiUpdateEnabled;
port.ConfiguredModeDataSetIndex = msg.ConfiguredModeDataSetIndex;
break;
}
return(Task.CompletedTask);
}
private static void AddCachePortAndPortModeInformation(DeviceType type, Version hardwareRevision, Version softwareRevision, PortInfo port, ProtocolKnowledge knowledge, IDeviceFactory deviceFactory)
{
var device = deviceFactory.Create(type);
if (device != null)
{
foreach (var message in device.GetStaticPortInfoMessages(hardwareRevision, softwareRevision).Select(b => MessageEncoder.Decode(b, null)))
{
switch (message)
{
case PortModeInformationMessage pmim:
pmim.HubId = port.HubId;
pmim.PortId = port.PortId;
break;
case PortInformationMessage pim:
pim.HubId = port.HubId;
pim.PortId = port.PortId;
break;
}
ApplyStaticProtocolKnowledge(message, knowledge);
}
}
}
