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

from __future__ import absolute_import

    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

    77

    def GetIconName(self):

    78

        return "Slave"

    79

    80

    def ExtractHexDecValue(self, value):

    81

        return ExtractHexDecValue(value)

    82

    83

    def GetSizeOfType(self, type):

    84

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

    85

    86

    def GetSlavePos(self):

    87

        return self.BaseParams.getIEC_Channel()

    88

    89

    def GetParamsAttributes(self, path=None):

    90

        if path:

    91

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

    92

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

    93

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

    94

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

    95

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

    96

        else:

    97

            params = []

    98

            if self.CTNParams:

    99

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

   100

            else:

   101

                params.append({

   102

                    'use': 'required',

   103

                    'type': 'element',

   104

                    'name': 'SlaveParams',

   105

                    'value': None,

   106

                    'children': []

   107

                })

   108

   109

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

   110

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

   111

                0,

   112

                {

   113

                    'use': 'optional',

   114

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

   115

                    'name': 'Type',

   116

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

   117

                })

   118

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

   119

                1,

   120

                {

   121

                    'use': 'optional',

   122

                    'type': 'unsignedLong',

   123

                    'name': 'Alias',

   124

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

   125

                })

   126

            return params

   127

   128

    def SetParamsAttribute(self, path, value):

   129

        self.GetSlaveInfos()

   130

        position = self.BaseParams.getIEC_Channel()

   131

   132

        if path == "SlaveParams.Type":

   133

            self.CTNParent.SetSlaveType(position, value)

   134

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

   135

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

   136

            # if self._View is not None:

   137

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

   138

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

   139

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

   140

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

   141

            return value, True

   142

        elif path == "SlaveParams.Alias":

   143

            self.CTNParent.SetSlaveAlias(position, value)

   144

            return value, True

   145

   146

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

   147

   148

        # Filter IEC_Channel, Slave_Type and Alias that have specific behavior

   149

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

   150

            self.CTNParent.SetSlavePosition(position, value)

   151

   152

        return value, refresh

   153

   154

    def GetSlaveInfos(self):

   155

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

   156

   157

    def GetSlaveVariables(self, limits):

   158

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

   159

   160

    def GetVariableLocationTree(self):

   161

        return {

   162

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

   163

            "type": LOCATION_CONFNODE,

   164

            "location": self.GetFullIEC_Channel(),

   165

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

   166

        }

   167

   168

    def CTNGenerate_C(self, buildpath, locations):

   169

        return [], "", False