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

    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]),

    71

        lambda 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

                print("Clt "+method_name)

   110

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

   111

            except erpc.transport.ConnectionClosed as e:

   112

                confnodesroot._SetConnector(None)

   113

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

   114

            except erpc.codec.CodecError as e:

   115

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

   116

            except erpc.client.RequestError as e:

   117

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

   118

            except MissingCallException as e:

   119

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

   120

            except Exception as e:

   121

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

   122

                          + traceback.format_exc()

   123

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

   124

                print(errmess)

   125

                confnodesroot._SetConnector(None)

   126

   127

            return self.PLCObjDefaults.get(method_name)

   128

        return exception_wrapper

   129

   130

   131

    PLCObjectERPCProxy = type(

   132

        "PLCObjectERPCProxy",

   133

        (ConnectorBase, BeremizPLCObjectServiceClient),

   134

        {name: rpc_wrapper(name)

   135

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

   136

   137

    try:

   138

        if IDhash:

   139

            ID = IDhash[0]

   140

            # load PSK from project

   141

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

   142

            if not os.path.exists(secpath):

   143

                confnodesroot.logger.write_error(

   144

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

   145

                return None

   146

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

   147

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

   148

        else:

   149

            # TODO if serial URI then 

   150

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

   151

   152

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

   153

   154

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

   155

        client = PLCObjectERPCProxy(clientManager)

   156

   157

    except Exception as e:

   158

        confnodesroot.logger.write_error(

   159

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

   160

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

   161

        return None

   162

   163

    # Check connection is effective.

   164

    IDPSK = client.GetPLCID()

   165

    if IDPSK:

   166

        ID, secret = IDPSK

   167

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

   168

    else:

   169

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

   170

   171

    return client