[libsigrokdecode.git] / decoders / miller / pd.py

##
## This file is part of the libsigrokdecode project.
##
## Copyright (C) 2017 Christoph Rackwitz <christoph.rackwitz@rwth-aachen.de>
##
## 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, see <http://www.gnu.org/licenses/>.
##

# http://www.gorferay.com/type-a-communications-interface/
# https://resources.infosecinstitute.com/introduction-rfid-security/
# https://www.radio-electronics.com/info/wireless/nfc/near-field-communications-modulation-rf-signal-interface.php
# https://www.researchgate.net/figure/Modified-Miller-Code_fig16_283498836

# Miller: either edge
# modified Miller: falling edge

import sigrokdecode as srd

def roundto(x, k=1.0):
    return round(x / k) * k

class Decoder(srd.Decoder):
    api_version = 3
    id = 'miller'
    name = 'Miller'
    longname = 'Miller encoding'
    desc = 'Miller encoding protocol.'
    license = 'gplv2+'
    inputs = ['logic']
    outputs = ['miller']
    channels = (
        {'id': 'data', 'name': 'Data', 'desc': 'Data signal'},
    )
    options = (
        {'id': 'baudrate', 'desc': 'Baud rate', 'default': 106000},
        {'id': 'edge', 'desc': 'Edge', 'default': 'falling', 'values': ('rising', 'falling', 'either')},
    )
    annotations = (
        ('bit', 'Bit'),
        ('bitstring', 'Bitstring'),
    )
    annotation_rows = tuple((u, v, (i,)) for i, (u, v) in enumerate(annotations))
    binary = (
        ('raw', 'Raw binary'),
    )

    def __init__(self):
        self.samplerate = None

    def metadata(self, key, value):
        if key == srd.SRD_CONF_SAMPLERATE:
            self.samplerate = value

    def start(self):
        self.out_ann = self.register(srd.OUTPUT_ANN)
        self.out_binary = self.register(srd.OUTPUT_BINARY)

    def decode_bits(self):
        timeunit = self.samplerate / self.options['baudrate']
        edgetype = self.options['edge'][0]

        self.wait({0: edgetype}) # first symbol, beginning of unit
        prevedge = self.samplenum

        # start of message: '0'
        prevbit = 0
        yield (0, prevedge, prevedge + timeunit)
        expectedstart = self.samplenum + timeunit

        # end of message: '0' followed by one idle symbol

        while True:
            self.wait([{0: edgetype}, {'skip': int(3 * timeunit)}])
            got_timeout = self.matched[1]
            sampledelta = (self.samplenum - prevedge)
            prevedge = self.samplenum
            timedelta = roundto(sampledelta / timeunit, 0.5)

            # a mark stands for a 1 bit
            # a mark has an edge in the middle

            # a space stands for a 0 bit
            # a space either has an edge at the beginning or no edge at all
            # after a mark, a space is edge-less
            # after a space, a space has an edge

            # we get 1.0, 1.5, 2.0 times between edges

            # end of transmission is always a space, either edged or edge-less

            if prevbit == 0: # space -> ???
                if timedelta == 1.0: # 1.0 units -> space
                    yield (0, self.samplenum, self.samplenum + timeunit)
                    prevbit = 0
                    expectedstart = self.samplenum + timeunit
                elif timedelta == 1.5: # 1.5 units -> mark
                    yield (1, expectedstart, self.samplenum + 0.5*timeunit)
                    prevbit = 1
                    expectedstart = self.samplenum + timeunit*0.5
                elif timedelta >= 2.0:
                    # idle symbol (end of message)
                    yield None
                else:
                    # assert timedelta >= 2.0
                    yield (False, self.samplenum - sampledelta, self.samplenum)
                    break
            else: # mark -> ???
                if timedelta <= 0.5:
                    yield (False, self.samplenum - sampledelta, self.samplenum)
                    break
                if timedelta == 1.0: # 1.0 units -> mark again (1.5 from start)
                    yield (1, expectedstart, self.samplenum + 0.5*timeunit)
                    prevbit = 1
                    expectedstart = self.samplenum + 0.5*timeunit
                elif timedelta == 1.5: # 1.5 units -> space (no pulse) and space (pulse)
                    yield (0, expectedstart, self.samplenum)
                    yield (0, self.samplenum, self.samplenum + timeunit)
                    prevbit = 0
                    expectedstart = self.samplenum + timeunit
                elif timedelta == 2.0: # 2.0 units -> space (no pulse) and mark (pulse)
                    yield (0, expectedstart, expectedstart + timeunit)
                    yield (1, self.samplenum - 0.5*timeunit, self.samplenum + 0.5*timeunit)
                    prevbit = 1
                    expectedstart = self.samplenum + timeunit*0.5
                else: # longer -> space and end of message
                    yield (0, expectedstart, expectedstart + timeunit)
                    yield None
                    break

    def decode_run(self):
        numbits = 0
        bitvalue = 0
        bitstring = ''
        stringstart = None
        stringend = None

        for bit in self.decode_bits():
            if bit is None:
                break

            (value, ss, es) = bit

            if value is False:
                self.put(int(ss), int(es), self.out_ann, [1, ['ERROR']])
            else:
                self.put(int(ss), int(es), self.out_ann, [0, ['{}'.format(value)]])

            if value is False:
                numbits = 0
                break

            if stringstart is None:
                stringstart = ss

            stringend = es

            bitvalue |= value << numbits
            numbits += 1

            bitstring += '{}'.format(value)
            if numbits % 4 == 0:
                bitstring += ' '

        if not numbits:
            return

        self.put(int(stringstart), int(stringend), self.out_ann, [1, ['{}'.format(bitstring)]])

        numbytes = numbits // 8 + (numbits % 8 > 0)
        bytestring = bitvalue.to_bytes(numbytes, 'little')
        self.put(int(stringstart), int(stringend), self.out_binary, [0, bytestring])

    def decode(self):
        while True:
            self.decode_run()
Commit	Line	Data
4e7f2d70 CR	1	##
	2	## This file is part of the libsigrokdecode project.
	3	##
	4	## Copyright (C) 2017 Christoph Rackwitz <christoph.rackwitz@rwth-aachen.de>
	5	##
	6	## This program is free software; you can redistribute it and/or modify
	7	## it under the terms of the GNU General Public License as published by
	8	## the Free Software Foundation; either version 2 of the License, or
	9	## (at your option) any later version.
	10	##
	11	## This program is distributed in the hope that it will be useful,
	12	## but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	## GNU General Public License for more details.
	15	##
	16	## You should have received a copy of the GNU General Public License
	17	## along with this program; if not, see <http://www.gnu.org/licenses/>.
	18	##
	19
	20	# http://www.gorferay.com/type-a-communications-interface/
	21	# https://resources.infosecinstitute.com/introduction-rfid-security/
	22	# https://www.radio-electronics.com/info/wireless/nfc/near-field-communications-modulation-rf-signal-interface.php
	23	# https://www.researchgate.net/figure/Modified-Miller-Code_fig16_283498836
	24
	25	# Miller: either edge
	26	# modified Miller: falling edge
	27
	28	import sigrokdecode as srd
	29
	30	def roundto(x, k=1.0):
	31	return round(x / k) * k
	32
	33	class Decoder(srd.Decoder):
	34	api_version = 3
	35	id = 'miller'
	36	name = 'Miller'
1f5685a6 UH	37	longname = 'Miller encoding'
1f5685a6 UH	38	desc = 'Miller encoding protocol.'
4e7f2d70 CR	39	license = 'gplv2+'
	40	inputs = ['logic']
	41	outputs = ['miller']
	42	channels = (
	43	{'id': 'data', 'name': 'Data', 'desc': 'Data signal'},
	44	)
	45	options = (
	46	{'id': 'baudrate', 'desc': 'Baud rate', 'default': 106000},
	47	{'id': 'edge', 'desc': 'Edge', 'default': 'falling', 'values': ('rising', 'falling', 'either')},
	48	)
	49	annotations = (
	50	('bit', 'Bit'),
	51	('bitstring', 'Bitstring'),
	52	)
	53	annotation_rows = tuple((u, v, (i,)) for i, (u, v) in enumerate(annotations))
31673692 UH	54	binary = (
	55	('raw', 'Raw binary'),
	56	)
4e7f2d70 CR	57
	58	def __init__(self):
	59	self.samplerate = None
	60
	61	def metadata(self, key, value):
	62	if key == srd.SRD_CONF_SAMPLERATE:
	63	self.samplerate = value
	64
	65	def start(self):
	66	self.out_ann = self.register(srd.OUTPUT_ANN)
	67	self.out_binary = self.register(srd.OUTPUT_BINARY)
	68
	69	def decode_bits(self):
	70	timeunit = self.samplerate / self.options['baudrate']
	71	edgetype = self.options['edge'][0]
	72
	73	self.wait({0: edgetype}) # first symbol, beginning of unit
	74	prevedge = self.samplenum
	75
	76	# start of message: '0'
	77	prevbit = 0
	78	yield (0, prevedge, prevedge + timeunit)
	79	expectedstart = self.samplenum + timeunit
	80
	81	# end of message: '0' followed by one idle symbol
	82
	83	while True:
	84	self.wait([{0: edgetype}, {'skip': int(3 * timeunit)}])
	85	got_timeout = self.matched[1]
	86	sampledelta = (self.samplenum - prevedge)
	87	prevedge = self.samplenum
	88	timedelta = roundto(sampledelta / timeunit, 0.5)
	89
	90	# a mark stands for a 1 bit
	91	# a mark has an edge in the middle
	92
	93	# a space stands for a 0 bit
	94	# a space either has an edge at the beginning or no edge at all
	95	# after a mark, a space is edge-less
	96	# after a space, a space has an edge
	97
	98	# we get 1.0, 1.5, 2.0 times between edges
	99
	100	# end of transmission is always a space, either edged or edge-less
	101
	102	if prevbit == 0: # space -> ???
	103	if timedelta == 1.0: # 1.0 units -> space
	104	yield (0, self.samplenum, self.samplenum + timeunit)
	105	prevbit = 0
	106	expectedstart = self.samplenum + timeunit
	107	elif timedelta == 1.5: # 1.5 units -> mark
	108	yield (1, expectedstart, self.samplenum + 0.5*timeunit)
	109	prevbit = 1
	110	expectedstart = self.samplenum + timeunit*0.5
	111	elif timedelta >= 2.0:
	112	# idle symbol (end of message)
	113	yield None
	114	else:
	115	# assert timedelta >= 2.0
	116	yield (False, self.samplenum - sampledelta, self.samplenum)
	117	break
	118	else: # mark -> ???
	119	if timedelta <= 0.5:
	120	yield (False, self.samplenum - sampledelta, self.samplenum)
121	break
122	if timedelta == 1.0: # 1.0 units -> mark again (1.5 from start)
123	yield (1, expectedstart, self.samplenum + 0.5*timeunit)
124	prevbit = 1
125	expectedstart = self.samplenum + 0.5*timeunit
126	elif timedelta == 1.5: # 1.5 units -> space (no pulse) and space (pulse)
127	yield (0, expectedstart, self.samplenum)
128	yield (0, self.samplenum, self.samplenum + timeunit)
129	prevbit = 0
130	expectedstart = self.samplenum + timeunit
131	elif timedelta == 2.0: # 2.0 units -> space (no pulse) and mark (pulse)
132	yield (0, expectedstart, expectedstart + timeunit)
133	yield (1, self.samplenum - 0.5timeunit, self.samplenum + 0.5timeunit)
134	prevbit = 1
135	expectedstart = self.samplenum + timeunit*0.5
136	else: # longer -> space and end of message
137	yield (0, expectedstart, expectedstart + timeunit)
138	yield None
139	break
140
141	def decode_run(self):
142	numbits = 0
143	bitvalue = 0
144	bitstring = ''
145	stringstart = None
146	stringend = None
147
148	for bit in self.decode_bits():
149	if bit is None:
150	break
151
152	(value, ss, es) = bit
153
154	if value is False:
155	self.put(int(ss), int(es), self.out_ann, [1, ['ERROR']])
156	else:
157	self.put(int(ss), int(es), self.out_ann, [0, ['{}'.format(value)]])
158
159	if value is False:
160	numbits = 0
161	break
162
163	if stringstart is None:
164	stringstart = ss
165
166	stringend = es
167
168	bitvalue \|= value << numbits
169	numbits += 1
170
171	bitstring += '{}'.format(value)
172	if numbits % 4 == 0:
173	bitstring += ' '
174
175	if not numbits:
176	return
177
178	self.put(int(stringstart), int(stringend), self.out_ann, [1, ['{}'.format(bitstring)]])
179
180	numbytes = numbits // 8 + (numbits % 8 > 0)
181	bytestring = bitvalue.to_bytes(numbytes, 'little')
31673692	182	self.put(int(stringstart), int(stringend), self.out_binary, [0, bytestring])
4e7f2d70 CR	183
	184	def decode(self):
	185	while True:
	186	self.decode_run()