1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677 |
- #!/usr/bin/env python3
- #
- # Simple pyprofibus dummy example using dummy PHY.
- # This example can be run without any PB hardware.
- #
- import sys
- sys.path.insert(0, "..")
- import pyprofibus
- def main(watchdog=None):
- master = None
- try:
- # Parse the config file.
- config = pyprofibus.PbConf.fromFile("example_dummy_twoslaves.conf")
- # Create a DP master.
- master = config.makeDPM()
- # Create the slave descriptions.
- outData = {}
- for slaveConf in config.slaveConfs:
- slaveDesc = slaveConf.makeDpSlaveDesc()
- # Set User_Prm_Data
- dp1PrmMask = bytearray((pyprofibus.dp.DpTelegram_SetPrm_Req.DPV1PRM0_FAILSAFE,
- pyprofibus.dp.DpTelegram_SetPrm_Req.DPV1PRM1_REDCFG,
- 0x00))
- dp1PrmSet = bytearray((pyprofibus.dp.DpTelegram_SetPrm_Req.DPV1PRM0_FAILSAFE,
- pyprofibus.dp.DpTelegram_SetPrm_Req.DPV1PRM1_REDCFG,
- 0x00))
- slaveDesc.setUserPrmData(slaveConf.gsd.getUserPrmData(dp1PrmMask=dp1PrmMask,
- dp1PrmSet=dp1PrmSet))
- # Register the slave at the DPM
- master.addSlave(slaveDesc)
- # Set initial output data.
- outData[slaveDesc.name] = bytearray((0x42, 0x24))
- # Initialize the DPM
- master.initialize()
- # Run the slave state machine.
- while True:
- # Write the output data.
- for slaveDesc in master.getSlaveList():
- slaveDesc.setMasterOutData(outData[slaveDesc.name])
- # Run slave state machines.
- handledSlaveDesc = master.run()
- # Get the in-data (receive)
- if handledSlaveDesc:
- inData = handledSlaveDesc.getMasterInData()
- if inData is not None:
- # In our example the output data shall be the inverted input.
- outData[handledSlaveDesc.name][0] = inData[1]
- outData[handledSlaveDesc.name][1] = inData[0]
- # Feed the system watchdog, if it is available.
- if watchdog is not None:
- watchdog()
- except pyprofibus.ProfibusError as e:
- print("Terminating: %s" % str(e))
- return 1
- finally:
- if master:
- master.destroy()
- return 0
- if __name__ == "__main__":
- import sys
- sys.exit(main())
|