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, etisserant@24: "LREAL":0x11,"STRING":0x09,"BYTE":0x05,"WORD":0x06,"DWORD":0x07, 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: etisserant@22: def GenerateConciseDCF(locations, current_location, nodelist): etisserant@22: """ etisserant@22: Fills a CanFestival network editor model, with DCF with requested PDO mappings. etisserant@22: @param locations: List of complete variables locations \ etisserant@22: [{"IEC_TYPE" : the IEC type (i.e. "INT", "STRING", ...) etisserant@22: "NAME" : name of the variable (generally "__IW0_1_2" style) etisserant@22: "DIR" : direction "Q","I" or "M" etisserant@22: "SIZE" : size "X", "B", "W", "D", "L" etisserant@22: "LOC" : tuple of interger for IEC location (0,1,2,...) etisserant@22: }, ...] etisserant@22: @param nodelist: CanFestival network editor model etisserant@22: @return: a modified copy of the given CanFestival network editor model etisserant@22: """ etisserant@22: 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 etisserant@22: for location in locations: etisserant@22: locationtype = location["IEC_TYPE"] etisserant@22: name = location["NAME"] etisserant@22: if name in DictLocations: lbessard@11: if DictLocations[name]["type"] != DicoTypes[locationtype]: lbessard@11: raise ValueError, "Conflict type for location \"%s\"" % name lbessard@11: else: etisserant@22: #get only the part of the location that concern this node etisserant@22: loc = location["LOC"][len(current_location):] etisserant@22: # loc correspond to (ID, INDEX, SUBINDEX [,BIT]) etisserant@22: if len(loc) not in (3, 4): etisserant@24: raise ValueError, "Bad location size : %s"%str(loc) etisserant@22: etisserant@22: direction = location["DIR"] etisserant@22: etisserant@22: sizelocation = location["SIZE"] lbessard@11: lbessard@11: # Extract and check nodeid etisserant@22: nodeid, index, subindex = loc[:3] etisserant@22: etisserant@22: # Check Id is in slave node list lbessard@11: if nodeid not in nodelist.SlaveNodes.keys(): etisserant@22: raise ValueError, "Non existing node ID : %d (variable %s)" % (nodeid,name) etisserant@22: etisserant@22: # Get the model for this node (made from EDS) lbessard@11: node = nodelist.SlaveNodes[nodeid]["Node"] lbessard@11: lbessard@11: # Extract and check index and subindex lbessard@11: if not node.IsEntry(index, subindex): etisserant@22: raise ValueError, "No such index/subindex (%x,%x) in ID : %d (variable %s)" % (index,subindex,nodeid,name) etisserant@22: etisserant@22: #Get the entry info lbessard@11: subentry_infos = node.GetSubentryInfos(index, subindex) lbessard@11: etisserant@22: # If a PDO mappable lbessard@11: if subentry_infos and subentry_infos["pdo"]: etisserant@22: if sizelocation == "X" and len(loc) > 3: lbessard@11: numbit = loc[4] etisserant@22: elif sizelocation != "X" and len(loc) > 3: etisserant@22: raise ValueError, "Cannot set bit offset for non bool '%s' variable (ID:%d,Idx:%x,sIdx:%x))" % (name,nodeid,index,subindex) lbessard@11: else: lbessard@11: numbit = None lbessard@11: etisserant@24: COlocationtype = DicoTypes[locationtype] lbessard@11: entryinfos = node.GetSubentryInfos(index, subindex) etisserant@24: if entryinfos["type"] != COlocationtype: etisserant@24: raise ValueError, "Invalid type \"%s\"-> %d != %d for location\"%s\"" % (locationtype,COlocationtype, entryinfos["type"] , name) etisserant@24: etisserant@24: typeinfos = node.GetEntryInfos(COlocationtype) etisserant@24: DictLocations[name] = {"type":COlocationtype, "pdotype":SlavePDOType[direction], etisserant@24: "nodeid": nodeid, "index": index,"subindex": subindex, etisserant@24: "bit": numbit, "size": typeinfos["size"], "sizelocation": sizelocation} etisserant@22: else: etisserant@22: raise ValueError, "Not PDO mappable variable : '%s' (ID:%d,Idx:%x,sIdx:%x))" % (name,nodeid,index,subindex) etisserant@22: 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 etisserant@24: indexname = \ etisserant@24: DictNameVariable[DictLocations[variable[1]]["pdotype"]][0] + \ etisserant@24: DictLocations[variable[1]]["sizelocation"] + \ etisserant@24: '_'.join(map(str,current_location)) + \ etisserant@24: "_" + \ etisserant@24: str(DictLocations[variable[1]]["nodeid"]) lbessard@11: mapvariableidx = DictNameVariable[DictLocations[variable[1]]["pdotype"]][1] + DictNameVariable[DictLocations[variable[1]]["sizelocation"]] * DictNameVariable["increment"] etisserant@24: etisserant@24: #indexname = DictNameVariable[DictLocations[variable[1]]["pdotype"]][0] + DictLocations[variable[1]]["sizelocation"] + str(DictLocations[variable[1]]["prefix"]) + "_" + str(DictLocations[variable[1]]["nodeid"]) etisserant@24: #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()