1

#!/usr/bin/env python

     2

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

     3

     4

# This file is part of Beremiz

     5

#

     6

# Copyright (C) 2011-2014: Laurent BESSARD, Edouard TISSERANT

     7

#                          RTES Lab : CRKim, JBLee, youcu

     8

#                          Higen Motor : Donggu Kang

     9

#

    10

# See COPYING file for copyrights details.

    11

    12

    13

    14

from PLCControler import LOCATION_CONFNODE, LOCATION_VAR_INPUT, LOCATION_VAR_OUTPUT, LOCATION_VAR_MEMORY

    15

from ConfigTreeNode import ConfigTreeNode

    16

    17

from etherlab.ConfigEditor import NodeEditor

    18

    19

# ------------------------------------------

    20

from etherlab.CommonEtherCATFunction import _CommonSlave

    21

# ------------------------------------------

    22

    23

    24

TYPECONVERSION = {"BOOL": "X", "SINT": "B", "INT": "W", "DINT": "D", "LINT": "L",

    25

                  "USINT": "B", "UINT": "W", "UDINT": "D", "ULINT": "L",

    26

                  "BYTE": "B", "WORD": "W", "DWORD": "D", "LWORD": "L"}

    27

    28

DATATYPECONVERSION = {"BOOL": "BIT", "SINT": "S8", "INT": "S16", "DINT": "S32", "LINT": "S64",

    29

                      "USINT": "U8", "UINT": "U16", "UDINT": "U32", "ULINT": "U64",

    30

                      "BYTE": "U8", "WORD": "U16", "DWORD": "U32", "LWORD": "U64"}

    31

    32

VARCLASSCONVERSION = {"T": LOCATION_VAR_INPUT, "R": LOCATION_VAR_OUTPUT, "RT": LOCATION_VAR_MEMORY}

    33

    34

    35

def ExtractHexDecValue(value):

    36

    try:

    37

        return int(value)

    38

    except Exception:

    39

        pass

    40

    try:

    41

        return int(value.replace("#", "0"), 16)

    42

    except Exception:

    43

        raise ValueError("Invalid value for HexDecValue \"%s\"" % value)

    44

    45

    46

def GenerateHexDecValue(value, base=10):

    47

    if base == 10:

    48

        return str(value)

    49

    elif base == 16:

    50

        return "#x%.8x" % value

    51

    else:

    52

        raise ValueError("Not supported base")

    53

    54

    55

def ExtractName(names, default=None):

    56

    if len(names) == 1:

    57

        return names[0].getcontent()

    58

    else:

    59

        for name in names:

    60

            if name.getLcId() == 1033:

    61

                return name.getcontent()

    62

    return default

    63

    64

    65

# --------------------------------------------------

    66

#                    Ethercat Node

    67

# --------------------------------------------------

    68

    69

class _EthercatSlaveCTN(object):

    70

    NODE_PROFILE = None

    71

    EditorType = NodeEditor

    72

    73

    def __init__(self):

    74

        # ----------- call ethercat mng. function --------------

    75

        self.CommonMethod = _CommonSlave(self)

    76

        self.SelectedRxPDOIndex = []

    77

        self.SelectedTxPDOIndex = []

    78

    79

    def GetIconName(self):

    80

        return "Slave"

    81

    82

    def ExtractHexDecValue(self, value):

    83

        return ExtractHexDecValue(value)

    84

    85

    def GetSizeOfType(self, type):

    86

        return TYPECONVERSION.get(self.GetCTRoot().GetBaseType(type), None)

    87

    88

    def GetSlavePos(self):

    89

        return self.BaseParams.getIEC_Channel()

    90

    91

    def GetParamsAttributes(self, path=None):

    92

        if path:

    93

            parts = path.split(".", 1)

    94

            if self.MandatoryParams and parts[0] == self.MandatoryParams[0]:

    95

                return self.MandatoryParams[1].getElementInfos(parts[0], parts[1])

    96

            elif self.CTNParams and parts[0] == self.CTNParams[0]:

    97

                return self.CTNParams[1].getElementInfos(parts[0], parts[1])

    98

        else:

    99

            params = []

   100

            if self.CTNParams:

   101

                params.append(self.CTNParams[1].getElementInfos(self.CTNParams[0]))

   102

            else:

   103

                params.append({

   104

                    'use': 'required',

   105

                    'type': 'element',

   106

                    'name': 'SlaveParams',

   107

                    'value': None,

   108

                    'children': []

   109

                })

   110

   111

            slave_type = self.CTNParent.GetSlaveType(self.GetSlavePos())

   112

            params[0]['children'].insert(

   113

                0,

   114

                {

   115

                    'use': 'optional',

   116

                    'type': self.CTNParent.GetSlaveTypesLibrary(self.NODE_PROFILE),

   117

                    'name': 'Type',

   118

                    'value': (slave_type["device_type"], slave_type)

   119

                })

   120

            params[0]['children'].insert(

   121

                1,

   122

                {

   123

                    'use': 'optional',

   124

                    'type': 'unsignedLong',

   125

                    'name': 'Alias',

   126

                    'value': self.CTNParent.GetSlaveAlias(self.GetSlavePos())

   127

                })

   128

            return params

   129

   130

    def SetParamsAttribute(self, path, value):

   131

        self.GetSlaveInfos()

   132

        position = self.BaseParams.getIEC_Channel()

   133

   134

        if path == "SlaveParams.Type":

   135

            self.CTNParent.SetSlaveType(position, value)

   136

            slave_type = self.CTNParent.GetSlaveType(self.GetSlavePos())

   137

            value = (slave_type["device_type"], slave_type)

   138

            # if self._View is not None:

   139

            #     wx.CallAfter(self._View.EtherCATManagementTreebook.SlaveStatePanel.RefreshSlaveInfos())

   140

            #     self._View.EtherCATManagementTreebook.SlaveStatePanel.RefreshSlaveInfos()

   141

            #     self._View.EtherCATManagementTreebook.PDOMonitoringPanel.PDOInfoUpdate()

   142

            #     self._View.EtherCATManagementTreebook.SmartView.Create_SmartView()

   143

            return value, True

   144

        elif path == "SlaveParams.Alias":

   145

            self.CTNParent.SetSlaveAlias(position, value)

   146

            return value, True

   147

   148

        value, refresh = ConfigTreeNode.SetParamsAttribute(self, path, value)

   149

   150

        # Filter IEC_Channel, Slave_Type and Alias that have specific behavior

   151

        if path == "BaseParams.IEC_Channel" and value != position:

   152

            self.CTNParent.SetSlavePosition(position, value)

   153

   154

        return value, refresh

   155

   156

    def GetSlaveInfos(self):

   157

        return self.CTNParent.GetSlaveInfos(self.GetSlavePos())

   158

   159

    def GetSlaveVariables(self, limits):

   160

        return self.CTNParent.GetSlaveVariables(self.GetSlavePos(), limits)

   161

   162

    def GetVariableLocationTree(self):

   163

        return {

   164

            "name": self.BaseParams.getName(),

   165

            "type": LOCATION_CONFNODE,

   166

            "location": self.GetFullIEC_Channel(),

   167

            "children": self.CTNParent.GetDeviceLocationTree(self.GetSlavePos(), self.GetCurrentLocation(), self.BaseParams.getName())

   168

        }

   169

   170

    def CTNGenerate_C(self, buildpath, locations):

   171

        return [], "", False