lbessard@11: #!/usr/bin/env python
lbessard@11: # -*- coding: utf-8 -*-
lbessard@11:
lbessard@11: #This file is part of Beremiz, a Integrated Development Environment for
lbessard@11: #programming IEC 61131-3 automates supporting plcopen standard and CanFestival.
lbessard@11: #
lbessard@11: #Copyright (C) 2007: Edouard TISSERANT and Laurent BESSARD
lbessard@11: #
lbessard@11: #See COPYING file for copyrights details.
lbessard@11: #
lbessard@11: #This library is free software; you can redistribute it and/or
lbessard@11: #modify it under the terms of the GNU General Public
lbessard@11: #License as published by the Free Software Foundation; either
lbessard@11: #version 2.1 of the License, or (at your option) any later version.
lbessard@11: #
lbessard@11: #This library is distributed in the hope that it will be useful,
lbessard@11: #but WITHOUT ANY WARRANTY; without even the implied warranty of
lbessard@11: #MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
lbessard@11: #General Public License for more details.
lbessard@11: #
lbessard@11: #You should have received a copy of the GNU General Public
lbessard@11: #License along with this library; if not, write to the Free Software
lbessard@11: #Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
lbessard@11:
lbessard@11: from types import *
lbessard@11:
lbessard@11: DicoTypes = {"BOOL":0x01, "SINT":0x02, "INT":0x03,"DINT":0x04,"LINT":0x10,
lbessard@11: "USINT":0x05,"UINT":0x06,"UDINT":0x07,"ULINT":0x1B,"REAL":0x08,
lbessard@11: "LREAL":0x11,"STRING":0x09,"BYTE":0x02,"WORD":0x03,"DWORD":0x04,
lbessard@11: "LWORD":0x1B,"WSTRING":0x0B}
lbessard@11:
lbessard@11: DictLocations = {}
lbessard@11: DictCobID = {}
lbessard@11: DictLocationsNotMapped = {}
lbessard@11: ListCobIDAvailable = []
lbessard@11: SlavesPdoNumber = {}
lbessard@11:
lbessard@11: # Constants for PDO types
lbessard@11: RPDO = 1
lbessard@11: TPDO = 2
lbessard@11: SlavePDOType = {"I" : TPDO, "Q" : RPDO}
lbessard@11: InvertPDOType = {RPDO : TPDO, TPDO : RPDO}
lbessard@11:
lbessard@11: DefaultTransmitTypeMaster = 0x01
lbessard@11:
lbessard@11: GenerateMasterMapping = lambda x:[None] + [(loc_infos["type"], name) for name, loc_infos in x]
lbessard@11:
lbessard@11: TrashVariableSizes = {1 : 0x01, 8 : 0x05, 16 : 0x06, 32 : 0x07, 64 : 0x1B}
lbessard@11:
lbessard@11:
lbessard@11: def GetSlavePDOIndexes(slave, type, parameters = False):
lbessard@11: indexes = []
lbessard@11: if type & RPDO:
lbessard@11: indexes.extend([idx for idx in slave.GetIndexes() if 0x1400 <= idx <= 0x15FF])
lbessard@11: if type & TPDO:
lbessard@11: indexes.extend([idx for idx in slave.GetIndexes() if 0x1800 <= idx <= 0x19FF])
lbessard@11: if not parameters:
lbessard@11: return [idx + 0x200 for idx in indexes]
lbessard@11: else:
lbessard@11: return indexes
lbessard@11:
lbessard@11:
lbessard@11: def LE_to_BE(value, size): # Convert Little Endian to Big Endian
lbessard@11: data = ("%" + str(size * 2) + "." + str(size * 2) + "X") % value
lbessard@11: list_car = [data[i:i+2] for i in xrange(0, len(data), 2)]
lbessard@11: list_car.reverse()
lbessard@11: return "".join([chr(int(car, 16)) for car in list_car])
lbessard@11:
lbessard@11:
lbessard@11:
lbessard@11: def SearchSlavePDOMapping(loc_infos, slave): # Search the TPDO or RPDO mapping where location is defined on the slave
lbessard@11: typeinfos = slave.GetEntryInfos(loc_infos["type"])
lbessard@11: model = (loc_infos["index"] << 16) + (loc_infos["subindex"] << 8) + typeinfos["size"]
lbessard@11: slavePDOidxlist = GetSlavePDOIndexes(slave, loc_infos["pdotype"])
lbessard@11:
lbessard@11: for PDOidx in slavePDOidxlist:
lbessard@11: values = slave.GetEntry(PDOidx)
lbessard@11: if values != None:
lbessard@11: for subindex, mapping in enumerate(values):
lbessard@11: if subindex != 0 and mapping == model:
lbessard@11: return PDOidx, subindex
lbessard@11: return None
lbessard@11:
lbessard@11: def GenerateMappingDCF(cobid, idx, pdomapping, mapped): # Build concise DCF
lbessard@11:
lbessard@11: # Create entry for RPDO or TPDO parameters and Disable PDO
lbessard@11: dcfdata = LE_to_BE(idx, 2) + LE_to_BE(0x01, 1) + LE_to_BE(0x04, 4) + LE_to_BE((0x80000000 + cobid), 4)
lbessard@11: # Set Transmit type synchrone
lbessard@11: dcfdata += LE_to_BE(idx, 2) + LE_to_BE(0x02, 1) + LE_to_BE(0x01, 4) + LE_to_BE(DefaultTransmitTypeSlave, 1)
lbessard@11: # Re-Enable PDO
lbessard@11: # ---- INDEX ----- --- SUBINDEX ---- ----- SIZE ------ ------ DATA ------
lbessard@11: dcfdata += LE_to_BE(idx, 2) + LE_to_BE(0x01, 1) + LE_to_BE(0x04, 4) + LE_to_BE(0x00000000 + cobid, 4)
lbessard@11: nbparams = 3
lbessard@11: if mapped == False and pdomapping != None:
lbessard@11: # Map Variables
lbessard@11: for subindex, (name, loc_infos) in enumerate(pdomapping):
lbessard@11: value = (loc_infos["index"] << 16) + (loc_infos["subindex"] << 8) + loc_infos["size"]
lbessard@11: dcfdata += LE_to_BE(idx + 0x200, 2) + LE_to_BE(subindex + 1, 1) + LE_to_BE(0x04, 4) + LE_to_BE(value, 4)
lbessard@11: nbparams += 1
lbessard@11: return dcfdata, nbparams
lbessard@11:
lbessard@11: def GetNewCobID(nodeid, type): # Return a cobid not used
lbessard@11: global ListCobIDAvailable, SlavesPdoNumber
lbessard@11:
lbessard@11: if len(ListCobIDAvailable) == 0:
lbessard@11: return None
lbessard@11:
lbessard@11: nbSlavePDO = SlavesPdoNumber[nodeid][type]
lbessard@11: if type == RPDO:
lbessard@11: if nbSlavePDO < 4:
lbessard@11: # For the fourth PDO -> cobid = 0x200 + ( numPdo parameters * 0x100) + nodeid
lbessard@11: newcobid = (0x200 + nbSlavePDO * 0x100 + nodeid)
lbessard@11: if newcobid in ListCobIDAvailable:
lbessard@11: ListCobIDAvailable.remove(newcobid)
lbessard@11: return newcobid, 0x1400 + nbSlavePDO
lbessard@11: return ListCobIDAvailable.pop(0), 0x1400 + nbSlavePDO
lbessard@11:
lbessard@11: elif type == TPDO:
lbessard@11: if nbSlavePDO < 4:
lbessard@11: # For the fourth PDO -> cobid = 0x180 + (numPdo parameters * 0x100) + nodeid
lbessard@11: newcobid = (0x180 + nbSlavePDO * 0x100 + nodeid)
lbessard@11: if newcobid in ListCobIDAvailable:
lbessard@11: ListCobIDAvailable.remove(newcobid)
lbessard@11: return newcobid, 0x1800 + nbSlavePDO
lbessard@11: return ListCobIDAvailable.pop(0), 0x1800 + nbSlavePDO
lbessard@11:
lbessard@11: for number in xrange(4):
lbessard@11: if type == RPDO:
lbessard@11: # For the fourth PDO -> cobid = 0x200 + ( numPdo * 0x100) + nodeid
lbessard@11: newcobid = (0x200 + number * 0x100 + nodeid)
lbessard@11: elif type == TPDO:
lbessard@11: # For the fourth PDO -> cobid = 0x180 + (numPdo * 0x100) + nodeid
lbessard@11: newcobid = (0x180 + number * 0x100 + nodeid)
lbessard@11: else:
lbessard@11: return None
lbessard@11: if newcobid in ListCobIDAvailable:
lbessard@11: ListCobIDAvailable.remove(newcobid)
lbessard@11: return newcobid
lbessard@11: return ListCobIDAvailable.pop(0)
lbessard@11:
lbessard@11:
lbessard@11: def GenerateConciseDCF(locations, busname, nodelist):
lbessard@11: global DictLocations, DictCobID, DictLocationsNotMapped, ListCobIDAvailable, SlavesPdoNumber, DefaultTransmitTypeSlave
lbessard@11:
lbessard@11: DictLocations = {}
lbessard@11: DictCobID = {}
lbessard@11: DictLocationsNotMapped = {}
lbessard@11: DictSDOparams = {}
lbessard@11: ListCobIDAvailable = range(0x180, 0x580)
lbessard@11: SlavesPdoNumber = {}
lbessard@11: DictNameVariable = { "" : 1, "X": 2, "B": 3, "W": 4, "D": 5, "L": 6, "increment": 0x100, 1:("__I", 0x2000), 2:("__Q", 0x4000)}
lbessard@11: DefaultTransmitTypeSlave = 0xFF
lbessard@11: # Master Node initialisation
lbessard@11:
lbessard@11: manager = nodelist.Manager
lbessard@11: masternode = manager.GetCurrentNodeCopy()
lbessard@11: if not masternode.IsEntry(0x1F22):
lbessard@11: masternode.AddEntry(0x1F22, 1, "")
lbessard@11: manager.AddSubentriesToCurrent(0x1F22, 127, masternode)
lbessard@11: # Adding trash mappable variables for unused mapped datas
lbessard@11: idxTrashVariables = 0x2000 + masternode.GetNodeID()
lbessard@11: TrashVariableValue = {}
lbessard@11: manager.AddMapVariableToCurrent(idxTrashVariables, "trashvariables", 3, len(TrashVariableSizes), masternode)
lbessard@11: for subidx, (size, typeidx) in enumerate(TrashVariableSizes.items()):
lbessard@11: manager.SetCurrentEntry(idxTrashVariables, subidx + 1, "TRASH%d" % size, "name", None, masternode)
lbessard@11: manager.SetCurrentEntry(idxTrashVariables, subidx + 1, typeidx, "type", None, masternode)
lbessard@11: TrashVariableValue[size] = (idxTrashVariables << 16) + ((subidx + 1) << 8) + size
lbessard@11:
lbessard@11:
lbessard@11: # Extract Master Node current empty mapping index
lbessard@11: CurrentPDOParamsIdx = {RPDO : 0x1400 + len(GetSlavePDOIndexes(masternode, RPDO)),
lbessard@11: TPDO : 0x1800 + len(GetSlavePDOIndexes(masternode, TPDO))}
lbessard@11:
lbessard@11: # Get list of all Slave's CobID and Slave's default SDO server parameters
lbessard@11: for nodeid, nodeinfos in nodelist.SlaveNodes.items():
lbessard@11: node = nodeinfos["Node"]
lbessard@11: node.SetNodeID(nodeid)
lbessard@11: DictSDOparams[nodeid] = {"RSDO" : node.GetEntry(0x1200,0x01), "TSDO" : node.GetEntry(0x1200,0x02)}
lbessard@11: slaveRpdoIndexes = GetSlavePDOIndexes(node, RPDO, True)
lbessard@11: slaveTpdoIndexes = GetSlavePDOIndexes(node, TPDO, True)
lbessard@11: SlavesPdoNumber[nodeid] = {RPDO : len(slaveRpdoIndexes), TPDO : len(slaveTpdoIndexes)}
lbessard@11: for PdoIdx in slaveRpdoIndexes + slaveTpdoIndexes:
lbessard@11: pdo_cobid = node.GetEntry(PdoIdx, 0x01)
lbessard@11: if pdo_cobid > 0x600 :
lbessard@11: pdo_cobid -= 0x80000000
lbessard@11: if pdo_cobid in ListCobIDAvailable:
lbessard@11: ListCobIDAvailable.remove(pdo_cobid)
lbessard@11:
lbessard@11: # Get list of locations check if exists and mappables -> put them in DictLocations
lbessard@11: for locationtype, name in locations:
lbessard@11: if name in DictLocations.keys():
lbessard@11: if DictLocations[name]["type"] != DicoTypes[locationtype]:
lbessard@11: raise ValueError, "Conflict type for location \"%s\"" % name
lbessard@11: else:
lbessard@11: loc = [i for i in name.split("_") if len(i) > 0]
lbessard@11: if len(loc) not in (4, 5):
lbessard@11: continue
lbessard@11:
lbessard@11: prefix = loc[0][0]
lbessard@11:
lbessard@11: # Extract and check busname
lbessard@11: if loc[0][1].isdigit():
lbessard@11: sizelocation = ""
lbessard@11: busnamelocation = int(loc[0][1:])
lbessard@11: else:
lbessard@11: sizelocation = loc[0][1]
lbessard@11: busnamelocation = int(loc[0][2:])
lbessard@11: if busnamelocation != busname:
lbessard@11: continue # A ne pas remplacer par un message d'erreur
lbessard@11:
lbessard@11: # Extract and check nodeid
lbessard@11: nodeid = int(loc[1])
lbessard@11: if nodeid not in nodelist.SlaveNodes.keys():
lbessard@11: continue
lbessard@11: node = nodelist.SlaveNodes[nodeid]["Node"]
lbessard@11:
lbessard@11: # Extract and check index and subindex
lbessard@11: index = int(loc[2])
lbessard@11: subindex = int(loc[3])
lbessard@11: if not node.IsEntry(index, subindex):
lbessard@11: continue
lbessard@11: subentry_infos = node.GetSubentryInfos(index, subindex)
lbessard@11:
lbessard@11: if subentry_infos and subentry_infos["pdo"]:
lbessard@11: if sizelocation == "X" and len(loc) > 4:
lbessard@11: numbit = loc[4]
lbessard@11: elif sizelocation != "X" and len(loc) > 4:
lbessard@11: continue
lbessard@11: else:
lbessard@11: numbit = None
lbessard@11:
lbessard@11: locationtype = DicoTypes[locationtype]
lbessard@11: entryinfos = node.GetSubentryInfos(index, subindex)
lbessard@11: if entryinfos["type"] != locationtype:
lbessard@11: raise ValueError, "Invalid type for location \"%s\"" % name
lbessard@11:
lbessard@11: typeinfos = node.GetEntryInfos(locationtype)
lbessard@11: DictLocations[name] = {"type":locationtype, "pdotype":SlavePDOType[prefix],
lbessard@11: "nodeid": nodeid, "index": index,"subindex": subindex,
lbessard@11: "bit": numbit, "size": typeinfos["size"], "busname": busname, "sizelocation": sizelocation}
lbessard@11:
lbessard@11: # Create DictCobID with variables already mapped and add them in DictValidLocations
lbessard@11: for name, locationinfos in DictLocations.items():
lbessard@11: node = nodelist.SlaveNodes[locationinfos["nodeid"]]["Node"]
lbessard@11: result = SearchSlavePDOMapping(locationinfos, node)
lbessard@11: if result != None:
lbessard@11: index, subindex = result
lbessard@11: cobid = nodelist.GetSlaveNodeEntry(locationinfos["nodeid"], index - 0x200, 1)
lbessard@11: if cobid not in DictCobID.keys():
lbessard@11: mapping = [None]
lbessard@11: values = node.GetEntry(index)
lbessard@11: for value in values[1:]:
lbessard@11: mapping.append(value % 0x100)
lbessard@11: DictCobID[cobid] = {"type" : InvertPDOType[locationinfos["pdotype"]], "mapping" : mapping}
lbessard@11:
lbessard@11: DictCobID[cobid]["mapping"][subindex] = (locationinfos["type"], name)
lbessard@11:
lbessard@11: else:
lbessard@11: if locationinfos["nodeid"] not in DictLocationsNotMapped.keys():
lbessard@11: DictLocationsNotMapped[locationinfos["nodeid"]] = {TPDO : [], RPDO : []}
lbessard@11: DictLocationsNotMapped[locationinfos["nodeid"]][locationinfos["pdotype"]].append((name, locationinfos))
lbessard@11:
lbessard@11: # Check Master Pdo parameters for cobid already used and remove it in ListCobIDAvailable
lbessard@11: ListPdoParams = [idx for idx in masternode.GetIndexes() if 0x1400 <= idx <= 0x15FF or 0x1800 <= idx <= 0x19FF]
lbessard@11: for idx in ListPdoParams:
lbessard@11: cobid = masternode.GetEntry(idx, 0x01)
lbessard@11: if cobid not in DictCobID.keys():
lbessard@11: ListCobIDAvailable.pop(cobid)
lbessard@11:
lbessard@11: #-------------------------------------------------------------------------------
lbessard@11: # Build concise DCF for the others locations
lbessard@11: #-------------------------------------------------------------------------------
lbessard@11:
lbessard@11: for nodeid, locations in DictLocationsNotMapped.items():
lbessard@11: # Get current concise DCF
lbessard@11: node = nodelist.SlaveNodes[nodeid]["Node"]
lbessard@11: nodeDCF = masternode.GetEntry(0x1F22, nodeid)
lbessard@11:
lbessard@11: if nodeDCF != None and nodeDCF != '':
lbessard@11: tmpnbparams = [i for i in nodeDCF[:4]]
lbessard@11: tmpnbparams.reverse()
lbessard@11: nbparams = int(''.join(["%2.2x"%ord(i) for i in tmpnbparams]), 16)
lbessard@11: dataparams = nodeDCF[4:]
lbessard@11: else:
lbessard@11: nbparams = 0
lbessard@11: dataparams = ""
lbessard@11:
lbessard@11: for pdotype in (TPDO, RPDO):
lbessard@11: pdosize = 0
lbessard@11: pdomapping = []
lbessard@11: for name, loc_infos in locations[pdotype]:
lbessard@11: pdosize += loc_infos["size"]
lbessard@11: # If pdo's size > 64 bits
lbessard@11: if pdosize > 64:
lbessard@11: result = GetNewCobID(nodeid, pdotype)
lbessard@11: if result:
lbessard@11: SlavesPdoNumber[nodeid][pdotype] += 1
lbessard@11: new_cobid, new_idx = result
lbessard@11: data, nbaddedparams = GenerateMappingDCF(new_cobid, new_idx, pdomapping, False)
lbessard@11: dataparams += data
lbessard@11: nbparams += nbaddedparams
lbessard@11: DictCobID[new_cobid] = {"type" : InvertPDOType[pdotype], "mapping" : GenerateMasterMapping(pdomapping)}
lbessard@11: pdosize = loc_infos["size"]
lbessard@11: pdomapping = [(name, loc_infos)]
lbessard@11: else:
lbessard@11: pdomapping.append((name, loc_infos))
lbessard@11: if len(pdomapping) > 0:
lbessard@11: result = GetNewCobID(nodeid, pdotype)
lbessard@11: if result:
lbessard@11: SlavesPdoNumber[nodeid][pdotype] += 1
lbessard@11: new_cobid, new_idx = result
lbessard@11: data, nbaddedparams = GenerateMappingDCF(new_cobid, new_idx, pdomapping, False)
lbessard@11: dataparams += data
lbessard@11: nbparams += nbaddedparams
lbessard@11: DictCobID[new_cobid] = {"type" : InvertPDOType[pdotype], "mapping" : GenerateMasterMapping(pdomapping)}
lbessard@11:
lbessard@11: dcf = LE_to_BE(nbparams, 0x04) + dataparams
lbessard@11: masternode.SetEntry(0x1F22, nodeid, dcf)
lbessard@11:
lbessard@11:
lbessard@11: #-------------------------------------------------------------------------------
lbessard@11: # Master Node Configuration
lbessard@11: #-------------------------------------------------------------------------------
lbessard@11:
lbessard@11: # Configure Master's SDO parameters entries
lbessard@11: for nodeid, SDOparams in DictSDOparams.items():
lbessard@11: SdoClient_index = [0x1280 + nodeid]
lbessard@11: manager.ManageEntriesOfCurrent(SdoClient_index,[], masternode)
lbessard@11: if SDOparams["RSDO"] != None:
lbessard@11: RSDO_cobid = SDOparams["RSDO"]
lbessard@11: else:
lbessard@11: RSDO_cobid = 0x600 + nodeid
lbessard@11:
lbessard@11: if SDOparams["TSDO"] != None:
lbessard@11: TSDO_cobid = SDOparams["TSDO"]
lbessard@11: else:
lbessard@11: TSDO_cobid = 0x580 + nodeid
lbessard@11:
lbessard@11: masternode.SetEntry(SdoClient_index[0], 0x01, RSDO_cobid)
lbessard@11: masternode.SetEntry(SdoClient_index[0], 0x02, TSDO_cobid)
lbessard@11: masternode.SetEntry(SdoClient_index[0], 0x03, nodeid)
lbessard@11:
lbessard@11: # Configure Master's PDO parameters entries and set cobid, transmit type
lbessard@11: for cobid, pdo_infos in DictCobID.items():
lbessard@11: current_idx = CurrentPDOParamsIdx[pdo_infos["type"]]
lbessard@11: addinglist = [current_idx, current_idx + 0x200]
lbessard@11: manager.ManageEntriesOfCurrent(addinglist, [], masternode)
lbessard@11: masternode.SetEntry(current_idx, 0x01, cobid)
lbessard@11: masternode.SetEntry(current_idx, 0x02, DefaultTransmitTypeMaster)
lbessard@11: if len(pdo_infos["mapping"]) > 2:
lbessard@11: manager.AddSubentriesToCurrent(current_idx + 0x200, len(pdo_infos["mapping"]) - 2, masternode)
lbessard@11:
lbessard@11: # Create Master's PDO mapping
lbessard@11: for subindex, variable in enumerate(pdo_infos["mapping"]):
lbessard@11: if subindex == 0:
lbessard@11: continue
lbessard@11: new_index = False
lbessard@11:
lbessard@11: if type(variable) != IntType:
lbessard@11:
lbessard@11: typeidx, varname = variable
lbessard@11: indexname = DictNameVariable[DictLocations[variable[1]]["pdotype"]][0] + DictLocations[variable[1]]["sizelocation"] + str(DictLocations[variable[1]]["busname"]) + "_" + str(DictLocations[variable[1]]["nodeid"])
lbessard@11: mapvariableidx = DictNameVariable[DictLocations[variable[1]]["pdotype"]][1] + DictNameVariable[DictLocations[variable[1]]["sizelocation"]] * DictNameVariable["increment"]
lbessard@11:
lbessard@11: if not masternode.IsEntry(mapvariableidx):
lbessard@11: manager.AddMapVariableToCurrent(mapvariableidx, indexname, 3, 1, masternode)
lbessard@11: new_index = True
lbessard@11: nbsubentries = masternode.GetEntry(mapvariableidx, 0x00)
lbessard@11: else:
lbessard@11: nbsubentries = masternode.GetEntry(mapvariableidx, 0x00)
lbessard@11: mapvariableidxbase = mapvariableidx
lbessard@11: while mapvariableidx < (mapvariableidxbase + 0x1FF) and nbsubentries == 0xFF:
lbessard@11: mapvariableidx += 0x800
lbessard@11: if not manager.IsCurrentEntry(mapvariableidx):
lbessard@11: manager.AddMapVariableToCurrent(mapvariableidx, indexname, 3, 1, masternode)
lbessard@11: new_index = True
lbessard@11: nbsubentries = masternode.GetEntry(mapvariableidx, 0x00)
lbessard@11:
lbessard@11: if mapvariableidx < 0x6000:
lbessard@11: if DictLocations[variable[1]]["bit"] != None:
lbessard@11: subindexname = "_" + str(DictLocations[variable[1]]["index"]) + "_" + str(DictLocations[variable[1]]["subindex"]) + "_" + str(DictLocations[variable[1]]["bit"])
lbessard@11: else:
lbessard@11: subindexname = "_" + str(DictLocations[variable[1]]["index"]) + "_" + str(DictLocations[variable[1]]["subindex"])
lbessard@11: if not new_index:
lbessard@11: manager.AddSubentriesToCurrent(mapvariableidx, 1, masternode)
lbessard@11: nbsubentries += 1
lbessard@11: masternode.SetMappingEntry(mapvariableidx, nbsubentries, values = {"name" : subindexname})
lbessard@11: masternode.SetMappingEntry(mapvariableidx, nbsubentries, values = {"type" : typeidx})
lbessard@11:
lbessard@11: # Map Variable
lbessard@11: typeinfos = manager.GetEntryInfos(typeidx)
lbessard@11: if typeinfos != None:
lbessard@11: value = (mapvariableidx << 16) + ((nbsubentries) << 8) + typeinfos["size"]
lbessard@11: masternode.SetEntry(current_idx + 0x200, subindex, value)
lbessard@11: else:
lbessard@11: masternode.SetEntry(current_idx + 0x200, subindex, TrashVariableValue[variable])
lbessard@11:
lbessard@11: CurrentPDOParamsIdx[pdo_infos["type"]] += 1
lbessard@11: #masternode.Print()
lbessard@11: return masternode
lbessard@11:
lbessard@11: if __name__ == "__main__":
lbessard@11: from nodemanager import *
lbessard@11: from nodelist import *
lbessard@11: import sys
lbessard@11:
lbessard@11: manager = NodeManager(sys.path[0])
lbessard@11: nodelist = NodeList(manager)
lbessard@11: result = nodelist.LoadProject("/home/deobox/Desktop/TestMapping")
lbessard@11:
lbessard@11: ## if result != None:
lbessard@11: ## print result
lbessard@11: ## else:
lbessard@11: ## print "MasterNode :"
lbessard@11: ## manager.CurrentNode.Print()
lbessard@11: ## for nodeid, node in nodelist.SlaveNodes.items():
lbessard@11: ## print "SlaveNode name=%s id=0x%2.2X :"%(node["Name"], nodeid)
lbessard@11: ## node["Node"].Print()
lbessard@11:
lbessard@11: #filepath = "/home/deobox/beremiz/test_nodelist/listlocations.txt"
lbessard@11: filepath = "/home/deobox/Desktop/TestMapping/listlocations.txt"
lbessard@11:
lbessard@11: file = open(filepath,'r')
lbessard@11: locations = [location.split(' ') for location in [line.strip() for line in file.readlines() if len(line) > 0]]
lbessard@11: file.close()
lbessard@11: GenerateConciseDCF(locations, 32, nodelist)
lbessard@11: print "MasterNode :"
lbessard@11: manager.CurrentNode.Print()
lbessard@11: #masternode.Print()