1

#!/usr/bin/env python

     2

# -*- coding: utf-8 -*-

     3

     4

# Written by Edouard TISSERANT (C) 2024

     5

# This file is part of Beremiz IDE

     6

# See COPYING file for copyrights details.

     7

     8

     9

import os.path

    10

import re

    11

import traceback

    12

from inspect import getmembers, isfunction

    13

    14

    15

import erpc

    16

    17

# eRPC service code

    18

from erpc_interface.erpc_PLCObject.interface import IBeremizPLCObjectService

    19

from erpc_interface.erpc_PLCObject.client import BeremizPLCObjectServiceClient

    20

from erpc_interface.erpc_PLCObject.common import trace_order, extra_file, PLCstatus_enum

    21

    22

import PSKManagement as PSK

    23

from connectors.ERPC.PSK_Adapter import SSLPSKClientTransport

    24

from connectors.ConnectorBase import ConnectorBase

    25

    26

enum_to_PLCstatus = dict(map(lambda t:(t[1],t[0]),getmembers(PLCstatus_enum, lambda x:type(x)==int)))

    27

    28

class MissingCallException(Exception):

    29

    pass

    30

    31

def ExceptionFromERPCReturn(ret):

    32

    return {1:Exception,

    33

            2:MissingCallException}.get(ret,ValueError)

    34

    35

def ReturnAsLastOutput(client_method, obj, args_wrapper, *args):

    36

    retval = erpc.Reference()

    37

    ret = client_method(obj, *args_wrapper(*args), retval)

    38

    if ret != 0:

    39

        raise ExceptionFromERPCReturn(ret)(client_method.__name__)

    40

    return retval.value

    41

    42

def TranslatedReturnAsLastOutput(translator):

    43

    def wrapper(client_method, obj, args_wrapper, *args):

    44

        res = ReturnAsLastOutput(client_method, obj, args_wrapper, *args)

    45

        return translator(res)

    46

    return wrapper

    47

    48

ReturnWrappers = {

    49

    "AppendChunkToBlob":ReturnAsLastOutput,

    50

    "GetLogMessage":TranslatedReturnAsLastOutput(

    51

        lambda res:(res.msg, res.tick, res.sec, res.nsec)),

    52

    "GetPLCID":TranslatedReturnAsLastOutput(

    53

        lambda res:(res.ID, res.PSK)),

    54

    "GetPLCstatus":TranslatedReturnAsLastOutput(

    55

        lambda res:(enum_to_PLCstatus[res.PLCstatus], res.logcounts)),

    56

    "GetTraceVariables":TranslatedReturnAsLastOutput(

    57

        lambda res:(enum_to_PLCstatus[res.PLCstatus],

    58

                    [(sample.tick, bytes(sample.TraceBuffer)) for sample in res.traces])),

    59

    "MatchMD5":ReturnAsLastOutput,

    60

    "NewPLC":ReturnAsLastOutput,

    61

    "SeedBlob":ReturnAsLastOutput,

    62

    "SetTraceVariablesList": ReturnAsLastOutput,

    63

    "StopPLC":ReturnAsLastOutput,

    64

}

    65

    66

ArgsWrappers = {

    67

    "NewPLC":

    68

        lambda md5sum, plcObjectBlobID, extrafiles: (

    69

            md5sum, plcObjectBlobID, [extra_file(*f) for f in extrafiles]),

    70

    "SetTraceVariablesList":

    71

        lambda orders : ([

    72

            trace_order(idx, b"" if force is None else force) 

    73

            for idx, force in orders],)

    74

}

    75

    76

def ERPC_connector_factory(uri, confnodesroot):

    77

    """

    78

    returns the ERPC connector

    79

    """

    80

    confnodesroot.logger.write(_("ERPC connecting to URI : %s\n") % uri)

    81

    82

    # TODO add parsing for serial URI

    83

    # ERPC:///dev/ttyXX:baudrate or ERPC://:COM4:baudrate

    84

    85

    try:

    86

        _scheme, location = uri.split("://",1)

    87

        locator, *IDhash = location.split('#',1)

    88

        x = re.match(r'(?P<host>[^\s:]+):?(?P<port>\d+)?', locator)

    89

        host = x.group('host')

    90

        port = x.group('port')

    91

        if port:

    92

            port = int(port)

    93

        else:

    94

            port = 3000

    95

    except Exception as e:

    96

        confnodesroot.logger.write_error(

    97

            'Malformed URI "%s": %s\n' % (uri, str(e)))

    98

        return None

    99

   100

    def rpc_wrapper(method_name):

   101

        client_method = getattr(BeremizPLCObjectServiceClient, method_name)

   102

        return_wrapper = ReturnWrappers.get(

   103

            method_name, 

   104

            lambda client_method, obj, args_wrapper, *args: client_method(obj, *args_wrapper(*args)))

   105

        args_wrapper = ArgsWrappers.get(method_name, lambda *x:x)

   106

   107

        def exception_wrapper(self, *args):

   108

            try:

   109

                return return_wrapper(client_method, self, args_wrapper, *args)

   110

            except erpc.transport.ConnectionClosed as e:

   111

                confnodesroot._SetConnector(None)

   112

                confnodesroot.logger.write_error(_("Connection lost!\n"))

   113

            except erpc.codec.CodecError as e:

   114

                confnodesroot.logger.write_warning(_("ERPC codec error: %s\n") % e)

   115

            except erpc.client.RequestError as e:

   116

                confnodesroot.logger.write_error(_("ERPC request error: %s\n") % e)                

   117

            except MissingCallException as e:

   118

                confnodesroot.logger.write_warning(_("Remote call not supported: %s\n") % e.message)

   119

            except Exception as e:

   120

                errmess = _("Exception calling remote PLC object fucntion %s:\n") % method_name \

   121

                          + traceback.format_exc()

   122

                confnodesroot.logger.write_error(errmess + "\n")

   123

                confnodesroot._SetConnector(None)

   124

   125

            return self.PLCObjDefaults.get(method_name)

   126

        return exception_wrapper

   127

   128

   129

    PLCObjectERPCProxy = type(

   130

        "PLCObjectERPCProxy",

   131

        (ConnectorBase, BeremizPLCObjectServiceClient),

   132

        {name: rpc_wrapper(name)

   133

            for name,_func in getmembers(IBeremizPLCObjectService, isfunction)})

   134

   135

    try:

   136

        if IDhash:

   137

            ID = IDhash[0]

   138

            # load PSK from project

   139

            secpath = os.path.join(str(confnodesroot.ProjectPath), 'psk', ID + '.secret')

   140

            if not os.path.exists(secpath):

   141

                confnodesroot.logger.write_error(

   142

                    'Error: Pre-Shared-Key Secret in %s is missing!\n' % secpath)

   143

                return None

   144

            secret = open(secpath).read().partition(':')[2].rstrip('\n\r')

   145

            transport = SSLPSKClientTransport(host, port, (secret, ID))

   146

        else:

   147

            # TODO if serial URI then 

   148

            # transport = erpc.transport.SerialTransport(device, baudrate)

   149

   150

            transport = erpc.transport.TCPTransport(host, port, False)

   151

   152

        clientManager = erpc.client.ClientManager(transport, erpc.basic_codec.BasicCodec)

   153

        client = PLCObjectERPCProxy(clientManager)

   154

   155

    except Exception as e:

   156

        confnodesroot.logger.write_error(

   157

            _("Connection to {loc} failed with exception {ex}\n").format(

   158

                loc=locator, ex=str(e)))

   159

        return None

   160

   161

    # Check connection is effective.

   162

    IDPSK = client.GetPLCID()

   163

    if IDPSK:

   164

        ID, secret = IDPSK

   165

        PSK.UpdateID(confnodesroot.ProjectPath, ID, secret, uri)

   166

    else:

   167

        confnodesroot.logger.write_warning(_("PLC did not provide identity and security infomation.\n"))

   168

   169

    return client