Search in sources :

Example 1 with CANOpenNetworkPayload

use of org.apache.plc4x.java.canopen.readwrite.CANOpenNetworkPayload in project plc4x by apache.

the class CANOpenProtocolLogic method publishEvent.

private void publishEvent(CANOpenService service, int nodeId, CANOpenPayload payload) {
    DefaultPlcSubscriptionHandle dispatchedHandle = null;
    for (Map.Entry<DefaultPlcConsumerRegistration, Consumer<PlcSubscriptionEvent>> entry : consumers.entrySet()) {
        DefaultPlcConsumerRegistration registration = entry.getKey();
        Consumer<PlcSubscriptionEvent> consumer = entry.getValue();
        for (PlcSubscriptionHandle handler : registration.getSubscriptionHandles()) {
            CANOpenSubscriptionHandle handle = (CANOpenSubscriptionHandle) handler;
            if (payload instanceof CANOpenPDOPayload) {
                if (handle.matches(service, nodeId)) {
                    logger.trace("Dispatching notification {} for node {} to {}", service, nodeId, handle);
                    dispatchedHandle = handle;
                    CANOpenPDOField field = (CANOpenPDOField) handle.getField();
                    byte[] data = ((CANOpenPDOPayload) payload).getPdo().getData();
                    try {
                        PlcValue value = DataItem.staticParse(new ReadBufferByteBased(data, ByteOrder.LITTLE_ENDIAN), field.getCanOpenDataType(), data.length);
                        DefaultPlcSubscriptionEvent event = new DefaultPlcSubscriptionEvent(Instant.now(), Collections.singletonMap(handle.getName(), new ResponseItem<>(PlcResponseCode.OK, value)));
                        consumer.accept(event);
                    } catch (ParseException e) {
                        logger.warn("Could not parse data to desired type: {}", field.getCanOpenDataType(), e);
                        DefaultPlcSubscriptionEvent event = new DefaultPlcSubscriptionEvent(Instant.now(), Collections.singletonMap(handle.getName(), new ResponseItem<>(PlcResponseCode.INVALID_DATA, new PlcNull())));
                        consumer.accept(event);
                    }
                }
            } else if (payload instanceof CANOpenHeartbeatPayload) {
                if (handle.matches(service, nodeId)) {
                    logger.trace("Dispatching notification {} for node {} to {}", service, nodeId, handle);
                    dispatchedHandle = handle;
                    final NMTState state = ((CANOpenHeartbeatPayload) payload).getState();
                    Map<String, PlcValue> fields = new HashMap<>();
                    fields.put("state", new PlcUSINT(state.getValue()));
                    fields.put("node", new PlcUSINT(nodeId));
                    PlcStruct struct = new PlcStruct(fields);
                    DefaultPlcSubscriptionEvent event = new DefaultPlcSubscriptionEvent(Instant.now(), Collections.singletonMap(handle.getName(), new ResponseItem<>(PlcResponseCode.OK, struct)));
                    consumer.accept(event);
                }
            } else if (payload instanceof CANOpenNetworkPayload) {
                if (handle.matches(service, nodeId)) {
                    logger.trace("Dispatching notification {} for node {} to {}", service, nodeId, handle);
                    dispatchedHandle = handle;
                    final NMTStateRequest state = ((CANOpenNetworkPayload) payload).getRequest();
                    Map<String, PlcValue> fields = new HashMap<>();
                    fields.put("state", new PlcUSINT(state.getValue()));
                    fields.put("node", new PlcUSINT(nodeId));
                    PlcStruct struct = new PlcStruct(fields);
                    DefaultPlcSubscriptionEvent event = new DefaultPlcSubscriptionEvent(Instant.now(), Collections.singletonMap(handle.getName(), new ResponseItem<>(PlcResponseCode.OK, struct)));
                    consumer.accept(event);
                }
            }
        }
    }
    if (dispatchedHandle == null) {
        logger.trace("Could not find subscription matching {} and node {}", service, nodeId);
    }
}
Also used : ConcurrentHashMap(java.util.concurrent.ConcurrentHashMap) HashMap(java.util.HashMap) LinkedHashMap(java.util.LinkedHashMap) PlcUSINT(org.apache.plc4x.java.spi.values.PlcUSINT) DefaultPlcSubscriptionEvent(org.apache.plc4x.java.spi.messages.DefaultPlcSubscriptionEvent) DefaultPlcSubscriptionHandle(org.apache.plc4x.java.spi.model.DefaultPlcSubscriptionHandle) Consumer(java.util.function.Consumer) PlcStruct(org.apache.plc4x.java.spi.values.PlcStruct) ResponseItem(org.apache.plc4x.java.spi.messages.utils.ResponseItem) DefaultPlcConsumerRegistration(org.apache.plc4x.java.spi.model.DefaultPlcConsumerRegistration) NMTState(org.apache.plc4x.java.canopen.readwrite.NMTState) CANOpenPDOPayload(org.apache.plc4x.java.canopen.readwrite.CANOpenPDOPayload) DefaultPlcSubscriptionEvent(org.apache.plc4x.java.spi.messages.DefaultPlcSubscriptionEvent) PlcSubscriptionEvent(org.apache.plc4x.java.api.messages.PlcSubscriptionEvent) PlcSubscriptionHandle(org.apache.plc4x.java.api.model.PlcSubscriptionHandle) DefaultPlcSubscriptionHandle(org.apache.plc4x.java.spi.model.DefaultPlcSubscriptionHandle) NMTStateRequest(org.apache.plc4x.java.canopen.readwrite.NMTStateRequest) CANOpenNetworkPayload(org.apache.plc4x.java.canopen.readwrite.CANOpenNetworkPayload) PlcValue(org.apache.plc4x.java.api.value.PlcValue) CANOpenPDOField(org.apache.plc4x.java.canopen.field.CANOpenPDOField) CANOpenHeartbeatPayload(org.apache.plc4x.java.canopen.readwrite.CANOpenHeartbeatPayload) PlcNull(org.apache.plc4x.java.spi.values.PlcNull) Map(java.util.Map) ConcurrentHashMap(java.util.concurrent.ConcurrentHashMap) HashMap(java.util.HashMap) LinkedHashMap(java.util.LinkedHashMap)

Aggregations

HashMap (java.util.HashMap)1 LinkedHashMap (java.util.LinkedHashMap)1 Map (java.util.Map)1 ConcurrentHashMap (java.util.concurrent.ConcurrentHashMap)1 Consumer (java.util.function.Consumer)1 PlcSubscriptionEvent (org.apache.plc4x.java.api.messages.PlcSubscriptionEvent)1 PlcSubscriptionHandle (org.apache.plc4x.java.api.model.PlcSubscriptionHandle)1 PlcValue (org.apache.plc4x.java.api.value.PlcValue)1 CANOpenPDOField (org.apache.plc4x.java.canopen.field.CANOpenPDOField)1 CANOpenHeartbeatPayload (org.apache.plc4x.java.canopen.readwrite.CANOpenHeartbeatPayload)1 CANOpenNetworkPayload (org.apache.plc4x.java.canopen.readwrite.CANOpenNetworkPayload)1 CANOpenPDOPayload (org.apache.plc4x.java.canopen.readwrite.CANOpenPDOPayload)1 NMTState (org.apache.plc4x.java.canopen.readwrite.NMTState)1 NMTStateRequest (org.apache.plc4x.java.canopen.readwrite.NMTStateRequest)1 DefaultPlcSubscriptionEvent (org.apache.plc4x.java.spi.messages.DefaultPlcSubscriptionEvent)1 ResponseItem (org.apache.plc4x.java.spi.messages.utils.ResponseItem)1 DefaultPlcConsumerRegistration (org.apache.plc4x.java.spi.model.DefaultPlcConsumerRegistration)1 DefaultPlcSubscriptionHandle (org.apache.plc4x.java.spi.model.DefaultPlcSubscriptionHandle)1 PlcNull (org.apache.plc4x.java.spi.values.PlcNull)1 PlcStruct (org.apache.plc4x.java.spi.values.PlcStruct)1