author | Andrey Skvortsov <andrej.skvortzov@gmail.com> |
Fri, 15 Sep 2017 18:51:42 +0300 | |
changeset 1805 | 52daabbb6f90 |
parent 1782 | 5b6ad7a7fd9d |
child 1826 | 91796f408540 |
permissions | -rw-r--r-- |
58 | 1 |
#!/usr/bin/env python |
2 |
# -*- coding: utf-8 -*- |
|
3 |
||
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
4 |
# This file is part of Beremiz, a Integrated Development Environment for |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
5 |
# programming IEC 61131-3 automates supporting plcopen standard and CanFestival. |
58 | 6 |
# |
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
7 |
# Copyright (C) 2007: Edouard TISSERANT and Laurent BESSARD |
58 | 8 |
# |
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
9 |
# See COPYING file for copyrights details. |
58 | 10 |
# |
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
11 |
# This program is free software; you can redistribute it and/or |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
12 |
# modify it under the terms of the GNU General Public License |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
13 |
# as published by the Free Software Foundation; either version 2 |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
14 |
# of the License, or (at your option) any later version. |
58 | 15 |
# |
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
16 |
# This program is distributed in the hope that it will be useful, |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
17 |
# but WITHOUT ANY WARRANTY; without even the implied warranty of |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
18 |
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
19 |
# GNU General Public License for more details. |
58 | 20 |
# |
1571
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
21 |
# You should have received a copy of the GNU General Public License |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
22 |
# along with this program; if not, write to the Free Software |
486f94a8032c
fix license notices in source files and license files under GPLv2+
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1278
diff
changeset
|
23 |
# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
58 | 24 |
|
25 |
from types import * |
|
26 |
||
27 |
# Translation between IEC types and Can Open types |
|
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
28 |
IECToCOType = { |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
29 |
"BOOL": 0x01, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
30 |
"SINT": 0x02, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
31 |
"INT": 0x03, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
32 |
"DINT": 0x04, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
33 |
"LINT": 0x10, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
34 |
"USINT": 0x05, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
35 |
"UINT": 0x06, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
36 |
"UDINT": 0x07, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
37 |
"ULINT": 0x1B, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
38 |
"REAL": 0x08, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
39 |
"LREAL": 0x11, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
40 |
"STRING": 0x09, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
41 |
"BYTE": 0x05, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
42 |
"WORD": 0x06, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
43 |
"DWORD": 0x07, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
44 |
"LWORD": 0x1B, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
45 |
"WSTRING": 0x0B |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
46 |
} |
58 | 47 |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
48 |
# Constants for PDO types |
58 | 49 |
RPDO = 1 |
50 |
TPDO = 2 |
|
51 |
||
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
52 |
SlavePDOType = {"I": TPDO, "Q": RPDO} |
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
53 |
InvertPDOType = {RPDO: TPDO, TPDO: RPDO} |
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
54 |
PDOTypeBaseIndex = {RPDO: 0x1400, TPDO: 0x1800} |
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
55 |
PDOTypeBaseCobId = {RPDO: 0x200, TPDO: 0x180} |
58 | 56 |
|
57 |
VariableIncrement = 0x100 |
|
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
58 |
VariableStartIndex = {TPDO: 0x2000, RPDO: 0x4000} |
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
59 |
VariableDirText = {TPDO: "__I", RPDO: "__Q"} |
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
60 |
VariableTypeOffset = dict(zip(["", "X", "B", "W", "D", "L"], range(6))) |
58 | 61 |
|
62 |
TrashVariables = [(1, 0x01), (8, 0x05), (16, 0x06), (32, 0x07), (64, 0x1B)] |
|
63 |
||
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
64 |
# ------------------------------------------------------------------------------- |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
65 |
# Specific exception for PDO mapping errors |
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
66 |
# ------------------------------------------------------------------------------- |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
67 |
|
1736
7e61baa047f0
clean-up: fix PEP8 E302 expected 2 blank lines, found 1
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1734
diff
changeset
|
68 |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
69 |
class PDOmappingException(Exception): |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
70 |
pass |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
71 |
|
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
72 |
|
58 | 73 |
def LE_to_BE(value, size): |
74 |
""" |
|
75 |
Convert Little Endian to Big Endian |
|
76 |
@param value: value expressed in integer |
|
77 |
@param size: number of bytes generated |
|
78 |
@return: a string containing the value converted |
|
79 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
80 |
|
58 | 81 |
data = ("%" + str(size * 2) + "." + str(size * 2) + "X") % value |
82 |
list_car = [data[i:i+2] for i in xrange(0, len(data), 2)] |
|
83 |
list_car.reverse() |
|
84 |
return "".join([chr(int(car, 16)) for car in list_car]) |
|
85 |
||
86 |
||
1744
69dfdb26f600
clean-up: fix PEP8 E251 unexpected spaces around keyword / parameter equals
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1743
diff
changeset
|
87 |
def GetNodePDOIndexes(node, type, parameters=False): |
58 | 88 |
""" |
89 |
Find the PDO indexes of a node |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
90 |
@param node: node |
58 | 91 |
@param type: type of PDO searched (RPDO or TPDO or both) |
92 |
@param parameters: indicate which indexes are expected (PDO paramaters : True or PDO mappings : False) |
|
93 |
@return: a list of indexes found |
|
94 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
95 |
|
58 | 96 |
indexes = [] |
97 |
if type & RPDO: |
|
98 |
indexes.extend([idx for idx in node.GetIndexes() if 0x1400 <= idx <= 0x15FF]) |
|
99 |
if type & TPDO: |
|
100 |
indexes.extend([idx for idx in node.GetIndexes() if 0x1800 <= idx <= 0x19FF]) |
|
101 |
if not parameters: |
|
102 |
return [idx + 0x200 for idx in indexes] |
|
103 |
else: |
|
104 |
return indexes |
|
105 |
||
106 |
||
107 |
def SearchNodePDOMapping(loc_infos, node): |
|
108 |
""" |
|
109 |
Find the PDO indexes of a node |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
110 |
@param node: node |
58 | 111 |
@param type: type of PDO searched (RPDO or TPDO or both) |
112 |
@param parameters: indicate which indexes are expected (PDO paramaters : True or PDO mappings : False) |
|
113 |
@return: a list of indexes found |
|
114 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
115 |
|
270 | 116 |
model = (loc_infos["index"] << 16) + (loc_infos["subindex"] << 8) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
117 |
|
58 | 118 |
for PDOidx in GetNodePDOIndexes(node, loc_infos["pdotype"]): |
119 |
values = node.GetEntry(PDOidx) |
|
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
120 |
if values is not None: |
58 | 121 |
for subindex, mapping in enumerate(values): |
270 | 122 |
if subindex != 0 and mapping & 0xFFFFFF00 == model: |
58 | 123 |
return PDOidx, subindex |
124 |
return None |
|
125 |
||
126 |
||
127 |
def GeneratePDOMappingDCF(idx, cobid, transmittype, pdomapping): |
|
128 |
""" |
|
129 |
Build concise DCF value for configuring a PDO |
|
130 |
@param idx: index of PDO parameters |
|
131 |
@param cobid: PDO generated COB ID |
|
132 |
@param transmittype : PDO transmit type |
|
133 |
@param pdomapping: list of PDO mappings |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
134 |
@return: a tuple of value and number of parameters to add to DCF |
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
135 |
""" |
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
136 |
|
1742
92932cd370a4
clean-up: fix PEP8 E225 missing whitespace around operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1741
diff
changeset
|
137 |
dcfdata = [] |
58 | 138 |
# Create entry for RPDO or TPDO parameters and Disable PDO |
1278
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
139 |
# ---- INDEX ----- --- SUBINDEX ---- ----- SIZE ------ ------ DATA ------ |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
140 |
dcfdata += [LE_to_BE(idx, 2) + LE_to_BE(0x01, 1) + LE_to_BE(0x04, 4) + LE_to_BE(0x80000000 + cobid, 4)] |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
141 |
# Set Transmit type |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
142 |
dcfdata += [LE_to_BE(idx, 2) + LE_to_BE(0x02, 1) + LE_to_BE(0x01, 4) + LE_to_BE(transmittype, 1)] |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
143 |
if len(pdomapping) > 0: |
1278
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
144 |
# Disable Mapping |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
145 |
dcfdata += [LE_to_BE(idx + 0x200, 2) + LE_to_BE(0x00, 1) + LE_to_BE(0x01, 4) + LE_to_BE(0x00, 1)] |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
146 |
# Map Variables |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
147 |
for subindex, (name, loc_infos) in enumerate(pdomapping): |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
148 |
value = (loc_infos["index"] << 16) + (loc_infos["subindex"] << 8) + loc_infos["size"] |
1278
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
149 |
dcfdata += [LE_to_BE(idx + 0x200, 2) + LE_to_BE(subindex + 1, 1) + LE_to_BE(0x04, 4) + LE_to_BE(value, 4)] |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
150 |
# Re-enable Mapping |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
151 |
dcfdata += [LE_to_BE(idx + 0x200, 2) + LE_to_BE(0x00, 1) + LE_to_BE(0x01, 4) + LE_to_BE(len(pdomapping), 1)] |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
152 |
# Re-Enable PDO |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
153 |
dcfdata += [LE_to_BE(idx, 2) + LE_to_BE(0x01, 1) + LE_to_BE(0x04, 4) + LE_to_BE(cobid, 4)] |
74afc7e86d00
CanFestival plugin fills master's DCF to prepare PDO mappings in a way conform to DSP-301
Edouard Tisserant
parents:
721
diff
changeset
|
154 |
return "".join(dcfdata), len(dcfdata) |
58 | 155 |
|
1736
7e61baa047f0
clean-up: fix PEP8 E302 expected 2 blank lines, found 1
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1734
diff
changeset
|
156 |
|
58 | 157 |
class ConciseDCFGenerator: |
158 |
||
159 |
def __init__(self, nodelist, nodename): |
|
160 |
# Dictionary of location informations classed by name |
|
161 |
self.IECLocations = {} |
|
162 |
# Dictionary of location that have not been mapped yet |
|
163 |
self.LocationsNotMapped = {} |
|
164 |
# Dictionary of location informations classed by name |
|
165 |
self.MasterMapping = {} |
|
166 |
# List of COB IDs available |
|
167 |
self.ListCobIDAvailable = range(0x180, 0x580) |
|
168 |
# Dictionary of mapping value where unexpected variables are stored |
|
169 |
self.TrashVariables = {} |
|
163
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
170 |
# Dictionary of pointed variables |
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
171 |
self.PointedVariables = {} |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
172 |
|
58 | 173 |
self.NodeList = nodelist |
174 |
self.Manager = self.NodeList.Manager |
|
175 |
self.MasterNode = self.Manager.GetCurrentNodeCopy() |
|
176 |
self.MasterNode.SetNodeName(nodename) |
|
177 |
self.PrepareMasterNode() |
|
178 |
||
163
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
179 |
def GetPointedVariables(self): |
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
180 |
return self.PointedVariables |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
181 |
|
58 | 182 |
def RemoveUsedNodeCobId(self, node): |
183 |
""" |
|
184 |
Remove all PDO COB ID used by the given node from the list of available COB ID |
|
185 |
@param node: node |
|
186 |
@return: a tuple of number of RPDO and TPDO for the node |
|
187 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
188 |
|
58 | 189 |
# Get list of all node TPDO and RPDO indexes |
190 |
nodeRpdoIndexes = GetNodePDOIndexes(node, RPDO, True) |
|
191 |
nodeTpdoIndexes = GetNodePDOIndexes(node, TPDO, True) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
192 |
|
58 | 193 |
# Mark all the COB ID of the node already mapped PDO as not available |
194 |
for PdoIdx in nodeRpdoIndexes + nodeTpdoIndexes: |
|
195 |
pdo_cobid = node.GetEntry(PdoIdx, 0x01) |
|
196 |
# Extract COB ID, if PDO isn't active |
|
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
197 |
if pdo_cobid > 0x600: |
58 | 198 |
pdo_cobid -= 0x80000000 |
199 |
# Remove COB ID from the list of available COB ID |
|
200 |
if pdo_cobid in self.ListCobIDAvailable: |
|
201 |
self.ListCobIDAvailable.remove(pdo_cobid) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
202 |
|
58 | 203 |
return len(nodeRpdoIndexes), len(nodeTpdoIndexes) |
204 |
||
205 |
def PrepareMasterNode(self): |
|
206 |
""" |
|
207 |
Add mandatory entries for DCF generation into MasterNode. |
|
208 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
209 |
|
58 | 210 |
# Adding DCF entry into Master node |
211 |
if not self.MasterNode.IsEntry(0x1F22): |
|
212 |
self.MasterNode.AddEntry(0x1F22, 1, "") |
|
213 |
self.Manager.AddSubentriesToCurrent(0x1F22, 127, self.MasterNode) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
214 |
|
58 | 215 |
# Adding trash mappable variables for unused mapped datas |
216 |
idxTrashVariables = 0x2000 + self.MasterNode.GetNodeID() |
|
217 |
# Add an entry for storing unexpected all variable |
|
218 |
self.Manager.AddMapVariableToCurrent(idxTrashVariables, self.MasterNode.GetNodeName()+"_trashvariables", 3, len(TrashVariables), self.MasterNode) |
|
219 |
for subidx, (size, typeidx) in enumerate(TrashVariables): |
|
220 |
# Add a subentry for storing unexpected variable of this size |
|
221 |
self.Manager.SetCurrentEntry(idxTrashVariables, subidx + 1, "TRASH%d" % size, "name", None, self.MasterNode) |
|
222 |
self.Manager.SetCurrentEntry(idxTrashVariables, subidx + 1, typeidx, "type", None, self.MasterNode) |
|
223 |
# Store the mapping value for this entry |
|
224 |
self.TrashVariables[size] = (idxTrashVariables << 16) + ((subidx + 1) << 8) + size |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
225 |
|
58 | 226 |
RPDOnumber, TPDOnumber = self.RemoveUsedNodeCobId(self.MasterNode) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
227 |
|
58 | 228 |
# Store the indexes of the first RPDO and TPDO available for MasterNode |
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
229 |
self.CurrentPDOParamsIdx = {RPDO: 0x1400 + RPDOnumber, TPDO: 0x1800 + TPDOnumber} |
58 | 230 |
|
231 |
# Prepare MasterNode with all nodelist slaves |
|
232 |
for idx, (nodeid, nodeinfos) in enumerate(self.NodeList.SlaveNodes.items()): |
|
233 |
node = nodeinfos["Node"] |
|
234 |
node.SetNodeID(nodeid) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
235 |
|
58 | 236 |
RPDOnumber, TPDOnumber = self.RemoveUsedNodeCobId(node) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
237 |
|
58 | 238 |
# Get Slave's default SDO server parameters |
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
239 |
RSDO_cobid = node.GetEntry(0x1200, 0x01) |
58 | 240 |
if not RSDO_cobid: |
241 |
RSDO_cobid = 0x600 + nodeid |
|
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
242 |
TSDO_cobid = node.GetEntry(0x1200, 0x02) |
58 | 243 |
if not TSDO_cobid: |
244 |
TSDO_cobid = 0x580 + nodeid |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
245 |
|
58 | 246 |
# Configure Master's SDO parameters entries |
247 |
self.Manager.ManageEntriesOfCurrent([0x1280 + idx], [], self.MasterNode) |
|
248 |
self.MasterNode.SetEntry(0x1280 + idx, 0x01, RSDO_cobid) |
|
249 |
self.MasterNode.SetEntry(0x1280 + idx, 0x02, TSDO_cobid) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
250 |
self.MasterNode.SetEntry(0x1280 + idx, 0x03, nodeid) |
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
251 |
|
58 | 252 |
def GetMasterNode(self): |
253 |
""" |
|
254 |
Return MasterNode. |
|
255 |
""" |
|
256 |
return self.MasterNode |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
257 |
|
58 | 258 |
def AddParamsToDCF(self, nodeid, data, nbparams): |
259 |
""" |
|
155 | 260 |
Add entry to DCF, for the requested nodeID |
58 | 261 |
@param nodeid: id of the slave (int) |
262 |
@param data: data to add to slave DCF (string) |
|
263 |
@param nbparams: number of params added to slave DCF (int) |
|
264 |
""" |
|
265 |
# Get current DCF for slave |
|
266 |
nodeDCF = self.MasterNode.GetEntry(0x1F22, nodeid) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
267 |
|
58 | 268 |
# Extract data and number of params in current DCF |
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
269 |
if nodeDCF is not None and nodeDCF != '': |
58 | 270 |
tmpnbparams = [i for i in nodeDCF[:4]] |
271 |
tmpnbparams.reverse() |
|
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
272 |
nbparams += int(''.join(["%2.2x" % ord(i) for i in tmpnbparams]), 16) |
58 | 273 |
data = nodeDCF[4:] + data |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
274 |
|
58 | 275 |
# Build new DCF |
276 |
dcf = LE_to_BE(nbparams, 0x04) + data |
|
277 |
# Set new DCF for slave |
|
278 |
self.MasterNode.SetEntry(0x1F22, nodeid, dcf) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
279 |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
280 |
def GetEmptyPDO(self, nodeid, pdotype, start_index=None): |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
281 |
""" |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
282 |
Search a not configured PDO for a slave |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
283 |
@param node: the slave node object |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
284 |
@param pdotype: type of PDO to generated (RPDO or TPDO) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
285 |
@param start_index: Index where search must start (default: None) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
286 |
@return tuple of PDO index, COB ID and number of subindex defined |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
287 |
""" |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
288 |
# If no start_index defined, start with PDOtype base index |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
289 |
if start_index is None: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
290 |
index = PDOTypeBaseIndex[pdotype] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
291 |
else: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
292 |
index = start_index |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
293 |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
294 |
# Search for all PDO possible index until find a configurable PDO |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
295 |
# starting from start_index |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
296 |
while index < PDOTypeBaseIndex[pdotype] + 0x200: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
297 |
values = self.NodeList.GetSlaveNodeEntry(nodeid, index + 0x200) |
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
298 |
if values is not None and values[0] > 0: |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
299 |
# Check that all subindex upper than 0 equal 0 => configurable PDO |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
300 |
if reduce(lambda x, y: x and y, map(lambda x: x == 0, values[1:]), True): |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
301 |
cobid = self.NodeList.GetSlaveNodeEntry(nodeid, index, 1) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
302 |
# If no COB ID defined in PDO, generate a new one (not used) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
303 |
if cobid == 0: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
304 |
if len(self.ListCobIDAvailable) == 0: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
305 |
return None |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
306 |
# Calculate COB ID from standard values |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
307 |
if index < PDOTypeBaseIndex[pdotype] + 4: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
308 |
cobid = PDOTypeBaseCobId[pdotype] + 0x100 * (index - PDOTypeBaseIndex[pdotype]) + nodeid |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
309 |
if cobid not in self.ListCobIDAvailable: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
310 |
cobid = self.ListCobIDAvailable.pop(0) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
311 |
return index, cobid, values[0] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
312 |
index += 1 |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
313 |
return None |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
314 |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
315 |
def AddPDOMapping(self, nodeid, pdotype, pdoindex, pdocobid, pdomapping, sync_TPDOs): |
58 | 316 |
""" |
155 | 317 |
Record a new mapping request for a slave, and add related slave config to the DCF |
58 | 318 |
@param nodeid: id of the slave (int) |
319 |
@param pdotype: type of PDO to generated (RPDO or TPDO) |
|
320 |
@param pdomapping: list od variables to map with PDO |
|
321 |
""" |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
322 |
# Add an entry to MasterMapping |
1768
691083b5682a
clean-up: fix PEP8 E128 continuation line under-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1767
diff
changeset
|
323 |
self.MasterMapping[pdocobid] = { |
691083b5682a
clean-up: fix PEP8 E128 continuation line under-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1767
diff
changeset
|
324 |
"type": InvertPDOType[pdotype], |
691083b5682a
clean-up: fix PEP8 E128 continuation line under-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1767
diff
changeset
|
325 |
"mapping": [None] + [(loc_infos["type"], name) for name, loc_infos in pdomapping] |
691083b5682a
clean-up: fix PEP8 E128 continuation line under-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1767
diff
changeset
|
326 |
} |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
327 |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
328 |
# Return the data to add to DCF |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
329 |
if sync_TPDOs: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
330 |
return GeneratePDOMappingDCF(pdoindex, pdocobid, 0x01, pdomapping) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
331 |
else: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
332 |
return GeneratePDOMappingDCF(pdoindex, pdocobid, 0xFF, pdomapping) |
58 | 333 |
return 0, "" |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
334 |
|
58 | 335 |
def GenerateDCF(self, locations, current_location, sync_TPDOs): |
336 |
""" |
|
337 |
Generate Concise DCF of MasterNode for the locations list given |
|
338 |
@param locations: list of locations to be mapped |
|
339 |
@param current_location: tuple of the located prefixes not to be considered |
|
340 |
@param sync_TPDOs: indicate if TPDO must be synchronous |
|
341 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
342 |
|
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
343 |
# ------------------------------------------------------------------------------- |
58 | 344 |
# Verify that locations correspond to real slave variables |
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
345 |
# ------------------------------------------------------------------------------- |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
346 |
|
58 | 347 |
# Get list of locations check if exists and mappables -> put them in IECLocations |
348 |
for location in locations: |
|
349 |
COlocationtype = IECToCOType[location["IEC_TYPE"]] |
|
350 |
name = location["NAME"] |
|
351 |
if name in self.IECLocations: |
|
352 |
if self.IECLocations[name]["type"] != COlocationtype: |
|
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
353 |
raise PDOmappingException(_("Type conflict for location \"%s\"") % name) |
58 | 354 |
else: |
355 |
# Get only the part of the location that concern this node |
|
356 |
loc = location["LOC"][len(current_location):] |
|
357 |
# loc correspond to (ID, INDEX, SUBINDEX [,BIT]) |
|
166 | 358 |
if len(loc) not in (2, 3, 4): |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
359 |
raise PDOmappingException(_("Bad location size : %s") % str(loc)) |
166 | 360 |
elif len(loc) == 2: |
361 |
continue |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
362 |
|
58 | 363 |
direction = location["DIR"] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
364 |
|
58 | 365 |
sizelocation = location["SIZE"] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
366 |
|
58 | 367 |
# Extract and check nodeid |
368 |
nodeid, index, subindex = loc[:3] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
369 |
|
58 | 370 |
# Check Id is in slave node list |
371 |
if nodeid not in self.NodeList.SlaveNodes.keys(): |
|
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
372 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
373 |
_("Non existing node ID : {a1} (variable {a2})"). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
374 |
format(a1=nodeid, a2=name)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
375 |
|
58 | 376 |
# Get the model for this node (made from EDS) |
377 |
node = self.NodeList.SlaveNodes[nodeid]["Node"] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
378 |
|
58 | 379 |
# Extract and check index and subindex |
380 |
if not node.IsEntry(index, subindex): |
|
1581
2295fdc5c271
fix translation strings with multiple parameters
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1571
diff
changeset
|
381 |
msg = _("No such index/subindex ({a1},{a2}) in ID : {a3} (variable {a4})").\ |
1744
69dfdb26f600
clean-up: fix PEP8 E251 unexpected spaces around keyword / parameter equals
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1743
diff
changeset
|
382 |
format(a1="%x" % index, a2="%x" % subindex, a3=nodeid, a4=name) |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
383 |
raise PDOmappingException(msg) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
384 |
|
58 | 385 |
# Get the entry info |
386 |
subentry_infos = node.GetSubentryInfos(index, subindex) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
387 |
|
58 | 388 |
# If a PDO mappable |
389 |
if subentry_infos and subentry_infos["pdo"]: |
|
390 |
if sizelocation == "X" and len(loc) > 3: |
|
61 | 391 |
numbit = loc[3] |
58 | 392 |
elif sizelocation != "X" and len(loc) > 3: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
393 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
394 |
_("Cannot set bit offset for non bool '{a1}' variable (ID:{a2},Idx:{a3},sIdx:{a4}))"). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
395 |
format(a1=name, a2=nodeid, a3="%x" % index, a4="%x" % subindex)) |
58 | 396 |
else: |
397 |
numbit = None |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
398 |
|
166 | 399 |
if location["IEC_TYPE"] != "BOOL" and subentry_infos["type"] != COlocationtype: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
400 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
401 |
_("Invalid type \"{a1}\"-> {a2} != {a3} for location \"{a4}\""). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
402 |
format(a1=location["IEC_TYPE"], |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
403 |
a2=COlocationtype, |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
404 |
a3=subentry_infos["type"], |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
405 |
a4=name)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
406 |
|
58 | 407 |
typeinfos = node.GetEntryInfos(COlocationtype) |
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
408 |
self.IECLocations[name] = { |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
409 |
"type": COlocationtype, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
410 |
"pdotype": SlavePDOType[direction], |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
411 |
"nodeid": nodeid, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
412 |
"index": index, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
413 |
"subindex": subindex, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
414 |
"bit": numbit, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
415 |
"size": typeinfos["size"], |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
416 |
"sizelocation": sizelocation |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
417 |
} |
58 | 418 |
else: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
419 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
420 |
_("Not PDO mappable variable : '{a1}' (ID:{a2},Idx:{a3},sIdx:{a4}))"). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
421 |
format(a1=name, a2=nodeid, a3="%x" % index, a4="%x" % subindex)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
422 |
|
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
423 |
# ------------------------------------------------------------------------------- |
58 | 424 |
# Search for locations already mapped |
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
425 |
# ------------------------------------------------------------------------------- |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
426 |
|
58 | 427 |
for name, locationinfos in self.IECLocations.items(): |
428 |
node = self.NodeList.SlaveNodes[locationinfos["nodeid"]]["Node"] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
429 |
|
58 | 430 |
# Search if slave has a PDO mapping this locations |
431 |
result = SearchNodePDOMapping(locationinfos, node) |
|
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
432 |
if result is not None: |
58 | 433 |
index, subindex = result |
434 |
# Get COB ID of the PDO |
|
435 |
cobid = self.NodeList.GetSlaveNodeEntry(locationinfos["nodeid"], index - 0x200, 1) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
436 |
|
58 | 437 |
# Add PDO to MasterMapping |
438 |
if cobid not in self.MasterMapping.keys(): |
|
80 | 439 |
# Verify that PDO transmit type is conform to sync_TPDOs |
440 |
transmittype = self.NodeList.GetSlaveNodeEntry(locationinfos["nodeid"], index - 0x200, 2) |
|
441 |
if sync_TPDOs and transmittype != 0x01 or transmittype != 0xFF: |
|
442 |
if sync_TPDOs: |
|
443 |
# Change TransmitType to SYNCHRONE |
|
444 |
data, nbparams = GeneratePDOMappingDCF(index - 0x200, cobid, 0x01, []) |
|
445 |
else: |
|
446 |
# Change TransmitType to ASYCHRONE |
|
447 |
data, nbparams = GeneratePDOMappingDCF(index - 0x200, cobid, 0xFF, []) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
448 |
|
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
449 |
# Add entry to slave dcf to change transmit type of |
80 | 450 |
self.AddParamsToDCF(locationinfos["nodeid"], data, nbparams) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
451 |
|
58 | 452 |
mapping = [None] |
453 |
values = node.GetEntry(index) |
|
454 |
# Store the size of each entry mapped in PDO |
|
455 |
for value in values[1:]: |
|
78 | 456 |
if value != 0: |
457 |
mapping.append(value % 0x100) |
|
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
458 |
self.MasterMapping[cobid] = {"type": InvertPDOType[locationinfos["pdotype"]], "mapping": mapping} |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
459 |
|
58 | 460 |
# Indicate that this PDO entry must be saved |
270 | 461 |
if locationinfos["bit"] is not None: |
462 |
if not isinstance(self.MasterMapping[cobid]["mapping"][subindex], ListType): |
|
463 |
self.MasterMapping[cobid]["mapping"][subindex] = [1] * self.MasterMapping[cobid]["mapping"][subindex] |
|
464 |
if locationinfos["bit"] < len(self.MasterMapping[cobid]["mapping"][subindex]): |
|
465 |
self.MasterMapping[cobid]["mapping"][subindex][locationinfos["bit"]] = (locationinfos["type"], name) |
|
466 |
else: |
|
467 |
self.MasterMapping[cobid]["mapping"][subindex] = (locationinfos["type"], name) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
468 |
|
58 | 469 |
else: |
470 |
# Add location to those that haven't been mapped yet |
|
471 |
if locationinfos["nodeid"] not in self.LocationsNotMapped.keys(): |
|
1739
ec153828ded2
clean-up: fix PEP8 E203 whitespace before ':' and whitespace before ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1736
diff
changeset
|
472 |
self.LocationsNotMapped[locationinfos["nodeid"]] = {TPDO: [], RPDO: []} |
58 | 473 |
self.LocationsNotMapped[locationinfos["nodeid"]][locationinfos["pdotype"]].append((name, locationinfos)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
474 |
|
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
475 |
# ------------------------------------------------------------------------------- |
58 | 476 |
# Build concise DCF for the others locations |
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
477 |
# ------------------------------------------------------------------------------- |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
478 |
|
58 | 479 |
for nodeid, locations in self.LocationsNotMapped.items(): |
61 | 480 |
node = self.NodeList.SlaveNodes[nodeid]["Node"] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
481 |
|
58 | 482 |
# Initialize number of params and data to add to node DCF |
483 |
nbparams = 0 |
|
484 |
dataparams = "" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
485 |
|
58 | 486 |
# Generate the best PDO mapping for each type of PDO |
487 |
for pdotype in (TPDO, RPDO): |
|
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
488 |
if len(locations[pdotype]) > 0: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
489 |
pdosize = 0 |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
490 |
pdomapping = [] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
491 |
result = self.GetEmptyPDO(nodeid, pdotype) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
492 |
if result is None: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
493 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
494 |
_("Unable to define PDO mapping for node %02x") % nodeid) |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
495 |
pdoindex, pdocobid, pdonbparams = result |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
496 |
for name, loc_infos in locations[pdotype]: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
497 |
pdosize += loc_infos["size"] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
498 |
# If pdo's size > 64 bits |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
499 |
if pdosize > 64 or len(pdomapping) >= pdonbparams: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
500 |
# Generate a new PDO Mapping |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
501 |
data, nbaddedparams = self.AddPDOMapping(nodeid, pdotype, pdoindex, pdocobid, pdomapping, sync_TPDOs) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
502 |
dataparams += data |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
503 |
nbparams += nbaddedparams |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
504 |
pdosize = loc_infos["size"] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
505 |
pdomapping = [(name, loc_infos)] |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
506 |
result = self.GetEmptyPDO(nodeid, pdotype, pdoindex + 1) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
507 |
if result is None: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
508 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
509 |
_("Unable to define PDO mapping for node %02x") % nodeid) |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
510 |
pdoindex, pdocobid, pdonbparams = result |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
511 |
else: |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
512 |
pdomapping.append((name, loc_infos)) |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
513 |
# If there isn't locations yet but there is still a PDO to generate |
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
514 |
if len(pdomapping) > 0: |
58 | 515 |
# Generate a new PDO Mapping |
340
651b8fb572e7
Adding support for using only PDO define in EDS file and not configured for adding mapping in node
greg
parents:
307
diff
changeset
|
516 |
data, nbaddedparams = self.AddPDOMapping(nodeid, pdotype, pdoindex, pdocobid, pdomapping, sync_TPDOs) |
58 | 517 |
dataparams += data |
518 |
nbparams += nbaddedparams |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
519 |
|
58 | 520 |
# Add number of params and data to node DCF |
521 |
self.AddParamsToDCF(nodeid, dataparams, nbparams) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
522 |
|
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
523 |
# ------------------------------------------------------------------------------- |
58 | 524 |
# Master Node Configuration |
1782
5b6ad7a7fd9d
clean-up: fix PEP8 E265 block comment should start with '# '
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1768
diff
changeset
|
525 |
# ------------------------------------------------------------------------------- |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
526 |
|
58 | 527 |
# Generate Master's Configuration from informations stored in MasterMapping |
528 |
for cobid, pdo_infos in self.MasterMapping.items(): |
|
529 |
# Get next PDO index in MasterNode for this PDO type |
|
530 |
current_idx = self.CurrentPDOParamsIdx[pdo_infos["type"]] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
531 |
|
58 | 532 |
# Search if there is already a PDO in MasterNode with this cob id |
533 |
for idx in GetNodePDOIndexes(self.MasterNode, pdo_infos["type"], True): |
|
534 |
if self.MasterNode.GetEntry(idx, 1) == cobid: |
|
535 |
current_idx = idx |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
536 |
|
58 | 537 |
# Add a PDO to MasterNode if not PDO have been found |
538 |
if current_idx == self.CurrentPDOParamsIdx[pdo_infos["type"]]: |
|
539 |
addinglist = [current_idx, current_idx + 0x200] |
|
540 |
self.Manager.ManageEntriesOfCurrent(addinglist, [], self.MasterNode) |
|
541 |
self.MasterNode.SetEntry(current_idx, 0x01, cobid) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
542 |
|
58 | 543 |
# Increment the number of PDO for this PDO type |
544 |
self.CurrentPDOParamsIdx[pdo_infos["type"]] += 1 |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
545 |
|
58 | 546 |
# Change the transmit type of the PDO |
547 |
if sync_TPDOs: |
|
548 |
self.MasterNode.SetEntry(current_idx, 0x02, 0x01) |
|
549 |
else: |
|
550 |
self.MasterNode.SetEntry(current_idx, 0x02, 0xFF) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
551 |
|
270 | 552 |
mapping = [] |
553 |
for item in pdo_infos["mapping"]: |
|
554 |
if isinstance(item, ListType): |
|
555 |
mapping.extend(item) |
|
556 |
else: |
|
557 |
mapping.append(item) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
558 |
|
58 | 559 |
# Add some subentries to PDO mapping if there is not enough |
270 | 560 |
if len(mapping) > 1: |
561 |
self.Manager.AddSubentriesToCurrent(current_idx + 0x200, len(mapping) - 1, self.MasterNode) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
562 |
|
58 | 563 |
# Generate MasterNode's PDO mapping |
270 | 564 |
for subindex, variable in enumerate(mapping): |
58 | 565 |
if subindex == 0: |
566 |
continue |
|
567 |
new_index = False |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
568 |
|
225 | 569 |
if isinstance(variable, (IntType, LongType)): |
58 | 570 |
# If variable is an integer then variable is unexpected |
571 |
self.MasterNode.SetEntry(current_idx + 0x200, subindex, self.TrashVariables[variable]) |
|
572 |
else: |
|
573 |
typeidx, varname = variable |
|
574 |
variable_infos = self.IECLocations[varname] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
575 |
|
58 | 576 |
# Calculate base index for storing variable |
1767
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
577 |
mapvariableidx = \ |
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
578 |
VariableStartIndex[variable_infos["pdotype"]] + \ |
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
579 |
VariableTypeOffset[variable_infos["sizelocation"]] * VariableIncrement + \ |
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
580 |
variable_infos["nodeid"] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
581 |
|
163
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
582 |
# Generate entry name |
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
583 |
indexname = "%s%s%s_%d" % (VariableDirText[variable_infos["pdotype"]], |
1767
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
584 |
variable_infos["sizelocation"], |
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
585 |
'_'.join(map(str, current_location)), |
c74815729afd
clean-up: fix PEP8 E127 continuation line over-indented for visual indent
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1765
diff
changeset
|
586 |
variable_infos["nodeid"]) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
587 |
|
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
588 |
# Search for an entry that has an empty subindex |
58 | 589 |
while mapvariableidx < VariableStartIndex[variable_infos["pdotype"]] + 0x2000: |
590 |
# Entry doesn't exist |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
591 |
if not self.MasterNode.IsEntry(mapvariableidx): |
58 | 592 |
# Add entry to MasterNode |
163
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
593 |
self.Manager.AddMapVariableToCurrent(mapvariableidx, "beremiz"+indexname, 3, 1, self.MasterNode) |
58 | 594 |
new_index = True |
595 |
nbsubentries = self.MasterNode.GetEntry(mapvariableidx, 0x00) |
|
596 |
else: |
|
597 |
# Get Number of subentries already defined |
|
598 |
nbsubentries = self.MasterNode.GetEntry(mapvariableidx, 0x00) |
|
599 |
# if entry is full, go to next entry possible or stop now |
|
600 |
if nbsubentries == 0xFF: |
|
601 |
mapvariableidx += 8 * VariableIncrement |
|
602 |
else: |
|
603 |
break |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
604 |
|
58 | 605 |
# Verify that a not full entry has been found |
606 |
if mapvariableidx < VariableStartIndex[variable_infos["pdotype"]] + 0x2000: |
|
607 |
# Generate subentry name |
|
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
608 |
if variable_infos["bit"] is not None: |
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
609 |
subindexname = "%(index)d_%(subindex)d_%(bit)d" % variable_infos |
58 | 610 |
else: |
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
611 |
subindexname = "%(index)d_%(subindex)d" % variable_infos |
58 | 612 |
# If entry have just been created, no subentry have to be added |
613 |
if not new_index: |
|
614 |
self.Manager.AddSubentriesToCurrent(mapvariableidx, 1, self.MasterNode) |
|
615 |
nbsubentries += 1 |
|
616 |
# Add informations to the new subentry created |
|
1744
69dfdb26f600
clean-up: fix PEP8 E251 unexpected spaces around keyword / parameter equals
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1743
diff
changeset
|
617 |
self.MasterNode.SetMappingEntry(mapvariableidx, nbsubentries, values={"name": subindexname}) |
69dfdb26f600
clean-up: fix PEP8 E251 unexpected spaces around keyword / parameter equals
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1743
diff
changeset
|
618 |
self.MasterNode.SetMappingEntry(mapvariableidx, nbsubentries, values={"type": typeidx}) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
619 |
|
58 | 620 |
# Set value of the PDO mapping |
621 |
typeinfos = self.Manager.GetEntryInfos(typeidx) |
|
1743
c3c3d1318130
clean-up: fix PEP8 E711 comparison to None should be 'if cond is not None:'
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1742
diff
changeset
|
622 |
if typeinfos is not None: |
58 | 623 |
value = (mapvariableidx << 16) + ((nbsubentries) << 8) + typeinfos["size"] |
624 |
self.MasterNode.SetEntry(current_idx + 0x200, subindex, value) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
625 |
|
163
482ca562d414
Support for extern pointer for located variables + Preliminary slave code (broken)
etisserant
parents:
155
diff
changeset
|
626 |
# Add variable to pointed variables |
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
627 |
self.PointedVariables[(mapvariableidx, nbsubentries)] = "%s_%s" % (indexname, subindexname) |
58 | 628 |
|
1736
7e61baa047f0
clean-up: fix PEP8 E302 expected 2 blank lines, found 1
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1734
diff
changeset
|
629 |
|
58 | 630 |
def GenerateConciseDCF(locations, current_location, nodelist, sync_TPDOs, nodename): |
631 |
""" |
|
632 |
Fills a CanFestival network editor model, with DCF with requested PDO mappings. |
|
633 |
@param locations: List of complete variables locations \ |
|
634 |
[{"IEC_TYPE" : the IEC type (i.e. "INT", "STRING", ...) |
|
635 |
"NAME" : name of the variable (generally "__IW0_1_2" style) |
|
636 |
"DIR" : direction "Q","I" or "M" |
|
637 |
"SIZE" : size "X", "B", "W", "D", "L" |
|
638 |
"LOC" : tuple of interger for IEC location (0,1,2,...) |
|
639 |
}, ...] |
|
640 |
@param nodelist: CanFestival network editor model |
|
641 |
@return: a modified copy of the given CanFestival network editor model |
|
642 |
""" |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
643 |
|
58 | 644 |
dcfgenerator = ConciseDCFGenerator(nodelist, nodename) |
645 |
dcfgenerator.GenerateDCF(locations, current_location, sync_TPDOs) |
|
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
646 |
masternode, pointers = dcfgenerator.GetMasterNode(), dcfgenerator.GetPointedVariables() |
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
647 |
# allow access to local OD from Master PLC |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
648 |
pointers.update(LocalODPointers(locations, current_location, masternode)) |
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
649 |
return masternode, pointers |
58 | 650 |
|
1736
7e61baa047f0
clean-up: fix PEP8 E302 expected 2 blank lines, found 1
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1734
diff
changeset
|
651 |
|
166 | 652 |
def LocalODPointers(locations, current_location, slave): |
653 |
IECLocations = {} |
|
654 |
pointers = {} |
|
655 |
for location in locations: |
|
656 |
COlocationtype = IECToCOType[location["IEC_TYPE"]] |
|
657 |
name = location["NAME"] |
|
658 |
if name in IECLocations: |
|
659 |
if IECLocations[name] != COlocationtype: |
|
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
660 |
raise PDOmappingException(_("Type conflict for location \"%s\"") % name) |
166 | 661 |
else: |
662 |
# Get only the part of the location that concern this node |
|
663 |
loc = location["LOC"][len(current_location):] |
|
664 |
# loc correspond to (ID, INDEX, SUBINDEX [,BIT]) |
|
665 |
if len(loc) not in (2, 3, 4): |
|
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
666 |
raise PDOmappingException(_("Bad location size : %s") % str(loc)) |
166 | 667 |
elif len(loc) != 2: |
668 |
continue |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
669 |
|
166 | 670 |
# Extract and check nodeid |
671 |
index, subindex = loc[:2] |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
672 |
|
166 | 673 |
# Extract and check index and subindex |
674 |
if not slave.IsEntry(index, subindex): |
|
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
675 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
676 |
_("No such index/subindex ({a1},{a2}) (variable {a3})"). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
677 |
format(a1="%x" % index, a2="%x" % subindex, a3=name)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
678 |
|
166 | 679 |
# Get the entry info |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
680 |
subentry_infos = slave.GetSubentryInfos(index, subindex) |
166 | 681 |
if subentry_infos["type"] != COlocationtype: |
1765
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
682 |
raise PDOmappingException( |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
683 |
_("Invalid type \"{a1}\"-> {a2} != {a3} for location \"{a4}\""). |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
684 |
format(a1=location["IEC_TYPE"], |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
685 |
a2=COlocationtype, |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
686 |
a3=subentry_infos["type"], |
ccf59c1f0b45
clean-up: fix PEP8 W602 deprecated form of raising exception
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1749
diff
changeset
|
687 |
a4=name)) |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
688 |
|
166 | 689 |
IECLocations[name] = COlocationtype |
690 |
pointers[(index, subindex)] = name |
|
691 |
return pointers |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
692 |
|
1749
d73b64672238
clean-up: fix PEP8 E305 expected 2 blank lines after class or function definition
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1747
diff
changeset
|
693 |
|
58 | 694 |
if __name__ == "__main__": |
1732
94ffe74e6895
clean-up: fix PEP8 E401 multiple imports on one line
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1730
diff
changeset
|
695 |
import os |
94ffe74e6895
clean-up: fix PEP8 E401 multiple imports on one line
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1730
diff
changeset
|
696 |
import sys |
94ffe74e6895
clean-up: fix PEP8 E401 multiple imports on one line
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1730
diff
changeset
|
697 |
import getopt |
58 | 698 |
|
699 |
def usage(): |
|
700 |
print """ |
|
701 |
Usage of config_utils.py test : |
|
702 |
||
703 |
%s [options] |
|
704 |
||
705 |
Options: |
|
706 |
--help (-h) |
|
707 |
Displays help informations for config_utils |
|
708 |
||
709 |
--reset (-r) |
|
710 |
Reset the reference result of config_utils test. |
|
711 |
Use with caution. Be sure that config_utils |
|
712 |
is currently working properly. |
|
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
713 |
""" % sys.argv[0] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
714 |
|
58 | 715 |
# Boolean that indicate if reference result must be redefined |
716 |
reset = False |
|
717 |
||
718 |
# Extract command options |
|
719 |
try: |
|
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
720 |
opts, args = getopt.getopt(sys.argv[1:], "hr", ["help", "reset"]) |
58 | 721 |
except getopt.GetoptError: |
722 |
# print help information and exit: |
|
723 |
usage() |
|
724 |
sys.exit(2) |
|
725 |
||
726 |
# Test each option |
|
727 |
for o, a in opts: |
|
728 |
if o in ("-h", "--help"): |
|
729 |
usage() |
|
730 |
sys.exit() |
|
731 |
elif o in ("-r", "--reset"): |
|
732 |
reset = True |
|
733 |
||
734 |
# Extract workspace base folder |
|
735 |
base_folder = sys.path[0] |
|
736 |
for i in xrange(3): |
|
737 |
base_folder = os.path.split(base_folder)[0] |
|
738 |
# Add CanFestival folder to search pathes |
|
739 |
sys.path.append(os.path.join(base_folder, "CanFestival-3", "objdictgen")) |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
740 |
|
58 | 741 |
from nodemanager import * |
742 |
from nodelist import * |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
743 |
|
58 | 744 |
# Open the test nodelist contained into test_config folder |
745 |
manager = NodeManager() |
|
746 |
nodelist = NodeList(manager) |
|
747 |
result = nodelist.LoadProject("test_config") |
|
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
748 |
|
58 | 749 |
# List of locations, we try to map for test |
1740
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
750 |
locations = [ |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
751 |
{"IEC_TYPE": "BYTE", "NAME": "__IB0_1_64_24576_1", "DIR": "I", "SIZE": "B", "LOC": (0, 1, 64, 24576, 1)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
752 |
{"IEC_TYPE": "INT", "NAME": "__IW0_1_64_25601_2", "DIR": "I", "SIZE": "W", "LOC": (0, 1, 64, 25601, 2)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
753 |
{"IEC_TYPE": "INT", "NAME": "__IW0_1_64_25601_3", "DIR": "I", "SIZE": "W", "LOC": (0, 1, 64, 25601, 3)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
754 |
{"IEC_TYPE": "INT", "NAME": "__QW0_1_64_25617_2", "DIR": "Q", "SIZE": "W", "LOC": (0, 1, 64, 25617, 1)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
755 |
{"IEC_TYPE": "BYTE", "NAME": "__IB0_1_64_24578_1", "DIR": "I", "SIZE": "B", "LOC": (0, 1, 64, 24578, 1)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
756 |
{"IEC_TYPE": "UDINT", "NAME": "__ID0_1_64_25638_1", "DIR": "I", "SIZE": "D", "LOC": (0, 1, 64, 25638, 1)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
757 |
{"IEC_TYPE": "UDINT", "NAME": "__ID0_1_64_25638_2", "DIR": "I", "SIZE": "D", "LOC": (0, 1, 64, 25638, 2)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
758 |
{"IEC_TYPE": "UDINT", "NAME": "__ID0_1_64_25638_3", "DIR": "I", "SIZE": "D", "LOC": (0, 1, 64, 25638, 3)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
759 |
{"IEC_TYPE": "UDINT", "NAME": "__ID0_1_64_25638_4", "DIR": "I", "SIZE": "D", "LOC": (0, 1, 64, 25638, 4)}, |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
760 |
{"IEC_TYPE": "UDINT", "NAME": "__ID0_1_4096_0", "DIR": "I", "SIZE": "D", "LOC": (0, 1, 4096, 0)} |
b789b695b5c6
clean-up: fix PEP8 E231 missing whitespace after ':' or ','
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1739
diff
changeset
|
761 |
] |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
762 |
|
58 | 763 |
# Generate MasterNode configuration |
764 |
try: |
|
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
765 |
masternode, pointedvariables = GenerateConciseDCF(locations, (0, 1), nodelist, True, "TestNode") |
58 | 766 |
except ValueError, message: |
1734
750eeb7230a1
clean-up: fix some PEP8 E228 missing whitespace around modulo operator
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1732
diff
changeset
|
767 |
print "%s\nTest Failed!" % message |
58 | 768 |
sys.exit() |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
769 |
|
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
770 |
import pprint |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
771 |
# Get Text corresponding to MasterNode |
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
772 |
result_node = masternode.PrintString() |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
773 |
result_vars = pprint.pformat(pointedvariables) |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
774 |
result = result_node + "\n********POINTERS*********\n" + result_vars + "\n" |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
775 |
|
58 | 776 |
# If reset has been choosen |
777 |
if reset: |
|
778 |
# Write Text into reference result file |
|
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
779 |
testfile = open("test_config/result.txt", "w") |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
780 |
testfile.write(result) |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
781 |
testfile.close() |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
782 |
|
58 | 783 |
print "Reset Successful!" |
784 |
else: |
|
150
204d515df3dd
Fixed non-regression test of config_utils in canfestival plugin
etisserant
parents:
80
diff
changeset
|
785 |
import os |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
786 |
|
307
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
787 |
testfile = open("test_config/result_tmp.txt", "w") |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
788 |
testfile.write(result) |
b80d3a84b8bf
Updated config_utils so that command line tests work.
etisserant
parents:
270
diff
changeset
|
789 |
testfile.close() |
1730
64d8f52bc8c8
clean-up for PEP8: fix W291 trailing whitespace
Andrey Skvortsov <andrej.skvortzov@gmail.com>
parents:
1722
diff
changeset
|
790 |
|
150
204d515df3dd
Fixed non-regression test of config_utils in canfestival plugin
etisserant
parents:
80
diff
changeset
|
791 |
os.system("diff test_config/result.txt test_config/result_tmp.txt") |
204d515df3dd
Fixed non-regression test of config_utils in canfestival plugin
etisserant
parents:
80
diff
changeset
|
792 |
os.remove("test_config/result_tmp.txt") |