# -*- coding: utf-8 -*- # # AWL simulator - counters # # Copyright 2012-2014 Michael Buesch # # This program is free software; you can redistribute it and/or modify # it under the terms of the GNU General Public License as published by # the Free Software Foundation; either version 2 of the License, or # (at your option) any later version. # # This program is distributed in the hope that it will be useful, # but WITHOUT ANY WARRANTY; without even the implied warranty of # MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the # GNU General Public License for more details. # # You should have received a copy of the GNU General Public License along # with this program; if not, write to the Free Software Foundation, Inc., # 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. # from __future__ import division, absolute_import, print_function, unicode_literals from awlsim.common.compat import * from awlsim.common.exceptions import * from awlsim.core.util import * class Counter(object): #+cdef """Classic AWL counter.""" __slots__ = ( "cpu", "index", "prevVKE_FR", "prevVKE_S", "prevVKE_ZV", "prevVKE_ZR", "counter", ) def __init__(self, cpu, index): self.cpu = cpu self.index = index self.prevVKE_FR = 0 self.prevVKE_S = 0 self.prevVKE_ZV = 0 self.prevVKE_ZR = 0 self.counter = 0 # Get the counter state (Q) def get(self): return 1 if self.counter else 0 # Get the binary counter value (DUAL) def getValueBin(self): return self.counter # Get the BCD counter value (DEZ) def getValueBCD(self): bcd = self.counter % 10 bcd |= ((self.counter // 10) % 10) << 4 bcd |= ((self.counter // 100) % 10) << 8 return bcd # Set the counter to a BCD value def setValueBCD(self, bcd): a, b, c = (bcd & 0xF),\ ((bcd >> 4) & 0xF),\ ((bcd >> 8) & 0xF) if bcd > 0x999 or a > 9 or b > 9 or c > 9: raise AwlSimError("Invalid BCD value") self.counter = a + (b * 10) + (c * 100) # Set (S) the counter to a value (accu1) def set(self, VKE): if ~self.prevVKE_S & VKE: self.setValueBCD(self.cpu.accu1.get()) self.prevVKE_S = VKE # Reset (R) the counter def reset(self): self.counter = 0 # Run the FR instruction def run_FR(self, VKE): if ~self.prevVKE_FR & VKE: self.prevVKE_S = 0 self.prevVKE_ZV = 0 self.prevVKE_ZR = 0 self.prevVKE_FR = VKE # Run the ZV instruction def run_ZV(self, VKE): if ~self.prevVKE_ZV & VKE: if self.counter < 999: self.counter += 1 self.prevVKE_ZV = VKE # Run the ZR instruction def run_ZR(self, VKE): if ~self.prevVKE_ZR & VKE: if self.counter > 0: self.counter -= 1 self.prevVKE_ZR = VKE