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

##
## This file is part of the libsigrokdecode project.
##
## Copyright (C) 2012-2014 Uwe Hermann <uwe@hermann-uwe.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/>.
##

import sigrokdecode as srd
from .parts import *

class Ann:
    PE, RSB0, RSB1, RSB2, CE, RFB, RHFB, REFB, \
    RLB, REEM, RP, LPMP, WP, WARN, DEV, = range(15)

VENDOR_CODE_ATMEL = 0x1e

class Decoder(srd.Decoder):
    api_version = 3
    id = 'avr_isp'
    name = 'AVR ISP'
    longname = 'AVR In-System Programming'
    desc = 'Atmel AVR In-System Programming (ISP) protocol.'
    license = 'gplv2+'
    inputs = ['spi']
    outputs = []
    tags = ['Debug/trace']
    annotations = (
        ('pe', 'Programming enable'),
        ('rsb0', 'Read signature byte 0'),
        ('rsb1', 'Read signature byte 1'),
        ('rsb2', 'Read signature byte 2'),
        ('ce', 'Chip erase'),
        ('rfb', 'Read fuse bits'),
        ('rhfb', 'Read high fuse bits'),
        ('refb', 'Read extended fuse bits'),
        ('rlb', 'Read lock bits'),
        ('reem', 'Read EEPROM memory'),
        ('rp', 'Read program memory'),
        ('lpmp' , 'Load program memory page'),
        ('wp', 'Write program memory'),
        ('warning', 'Warning'),
        ('dev', 'Device'),
    )
    annotation_rows = (
        ('commands', 'Commands', (Ann.PE, Ann.RSB0, Ann.RSB1, Ann.RSB2,
            Ann.CE, Ann.RFB, Ann.RHFB, Ann.REFB,
            Ann.RLB, Ann.REEM, Ann.RP, Ann.LPMP, Ann.WP,)),
        ('warnings', 'Warnings', (Ann.WARN,)),
        ('devs', 'Devices', (Ann.DEV,)),
    )

    def __init__(self):
        self.reset()

    def reset(self):
        self.state = 'IDLE'
        self.mosi_bytes, self.miso_bytes = [], []
        self.ss_cmd, self.es_cmd = 0, 0
        self.xx, self.yy, self.zz, self.mm = 0, 0, 0, 0
        self.ss_device = None

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

    def putx(self, data):
        self.put(self.ss_cmd, self.es_cmd, self.out_ann, data)

    def handle_cmd_programming_enable(self, cmd, ret):
        # Programming enable.
        # Note: The chip doesn't send any ACK for 'Programming enable'.
        self.putx([Ann.PE, ['Programming enable']])

        # Sanity check on reply.
        if ret[1:4] != [0xac, 0x53, cmd[2]]:
            self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])

    def handle_cmd_read_signature_byte_0x00(self, cmd, ret):
        # Signature byte 0x00: vendor code.
        self.vendor_code = ret[3]
        v = vendor_code[self.vendor_code]
        self.putx([Ann.RSB0, ['Vendor code: 0x%02x (%s)' % (ret[3], v)]])

        # Store for later.
        self.xx = cmd[1] # Same as ret[2].
        self.yy = cmd[3]
        self.zz = ret[0]

        # Sanity check on reply.
        if ret[1] != 0x30 or ret[2] != cmd[1]:
            self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])

        # Sanity check for the vendor code.
        if self.vendor_code != VENDOR_CODE_ATMEL:
            self.putx([Ann.WARN, ['Warning: Vendor code was not 0x1e (Atmel)!']])

    def handle_cmd_read_signature_byte_0x01(self, cmd, ret):
        # Signature byte 0x01: part family and memory size.
        self.part_fam_flash_size = ret[3]
        self.putx([Ann.RSB1, ['Part family / memory size: 0x%02x' % ret[3]]])

        # Store for later.
        self.mm = cmd[3]
        self.ss_device = self.ss_cmd

        # Sanity check on reply.
        if ret[1] != 0x30 or ret[2] != cmd[1] or ret[0] != self.yy:
            self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])

    def handle_cmd_read_signature_byte_0x02(self, cmd, ret):
        # Signature byte 0x02: part number.
        self.part_number = ret[3]
        self.putx([Ann.RSB2, ['Part number: 0x%02x' % ret[3]]])

        p = part[(self.part_fam_flash_size, self.part_number)]
        data = [Ann.DEV, ['Device: Atmel %s' % p]]
        self.put(self.ss_device, self.es_cmd, self.out_ann, data)

        # Sanity check on reply.
        if ret[1] != 0x30 or ret[2] != self.xx or ret[0] != self.mm:
            self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])

        self.xx, self.yy, self.zz, self.mm = 0, 0, 0, 0

    def handle_cmd_chip_erase(self, cmd, ret):
        # Chip erase (erases both flash an EEPROM).
        # Upon successful chip erase, the lock bits will also be erased.
        # The only way to end a Chip Erase cycle is to release RESET#.
        self.putx([Ann.CE, ['Chip erase']])

        # TODO: Check/handle RESET#.

        # Sanity check on reply.
        bit = (ret[2] & (1 << 7)) >> 7
        if ret[1] != 0xac or bit != 1 or ret[3] != cmd[2]:
            self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])

    def handle_cmd_read_fuse_bits(self, cmd, ret):
        # Read fuse bits.
        self.putx([Ann.RFB, ['Read fuse bits: 0x%02x' % ret[3]]])

        # TODO: Decode fuse bits.
        # TODO: Sanity check on reply.

    def handle_cmd_read_fuse_high_bits(self, cmd, ret):
        # Read fuse high bits.
        self.putx([Ann.RHFB, ['Read fuse high bits: 0x%02x' % ret[3]]])

        # TODO: Decode fuse bits.
        # TODO: Sanity check on reply.

    def handle_cmd_read_extended_fuse_bits(self, cmd, ret):
        # Read extended fuse bits.
        self.putx([Ann.REFB, ['Read extended fuse bits: 0x%02x' % ret[3]]])

        # TODO: Decode fuse bits.
        # TODO: Sanity check on reply.

    def handle_cmd_read_lock_bits(self, cmd, ret):
        # Read lock bits
        self.putx([Ann.RLB, ['Read lock bits: 0x%02x' % ret[3]]])

    def handle_cmd_read_eeprom_memory(self, cmd, ret):
        # Read EEPROM Memory
        _addr = ((cmd[1] & 1) << 8) + cmd[2]
        self.putx([Ann.REEM, ['Read EEPROM Memory: [0x%03x]: 0x%02x' % (_addr, ret[3])]])

    def handle_cmd_read_program_memory(self, cmd, ret):
        # Read Program Memory
        _HL = 'Low'
        _H = 'L'
        if cmd[0] & 0x08:
            _HL = 'High'
            _H = 'H'
        _addr = ((cmd[1] & 0x0f) << 8) + cmd[2]
        self.putx([Ann.RP, [
            'Read program memory %s: [0x%03x]: 0x%02x' % (_HL, _addr, ret[3]),
            '[%03x%s]:%02x' % (_addr, _H, ret[3]),
            '%02x' % ret[3]
        ]])

    def handle_cmd_load_program_memory_page(self, cmd, ret):
        # Load Program Memory Page
        _HL = 'Low'
        _H = 'L'
        if cmd[0] & 0x08:
            _HL = 'High'
            _H = 'H'
        _addr = cmd[2] & 0x1F
        self.putx([Ann.LPMP, [
            'Load program memory page %s: [0x%03x]: 0x%02x' % (_HL, _addr, cmd[3]),
            '[%03x%s]=%02x' % (_addr, _H, cmd[3]),
            '%02x' % cmd[3]
        ]])

    def handle_cmd_write_program_memory_page(self, cmd, ret):
        # Write Program Memory Page
        _addr = ((cmd[1] & 0x0F) << 3) + (cmd[2] << 5)
        self.putx([Ann.WP, ['Write program memory page: 0x%02x' % _addr]])

    def handle_command(self, cmd, ret):
        if cmd[:2] == [0xac, 0x53]:
            self.handle_cmd_programming_enable(cmd, ret)
        elif cmd[0] == 0xac and (cmd[1] & (1 << 7)) == (1 << 7):
            self.handle_cmd_chip_erase(cmd, ret)
        elif cmd[:3] == [0x50, 0x00, 0x00]:
            self.handle_cmd_read_fuse_bits(cmd, ret)
        elif cmd[:3] == [0x58, 0x08, 0x00]:
            self.handle_cmd_read_fuse_high_bits(cmd, ret)
        elif cmd[:3] == [0x50, 0x08, 0x00]:
            self.handle_cmd_read_extended_fuse_bits(cmd, ret)
        elif cmd[0] == 0x30 and cmd[2] == 0x00:
            self.handle_cmd_read_signature_byte_0x00(cmd, ret)
        elif cmd[0] == 0x30 and cmd[2] == 0x01:
            self.handle_cmd_read_signature_byte_0x01(cmd, ret)
        elif cmd[0] == 0x30 and cmd[2] == 0x02:
            self.handle_cmd_read_signature_byte_0x02(cmd, ret)
        elif cmd[:2] == [0x58, 0x00]:
            self.handle_cmd_read_lock_bits(cmd,ret)
        elif cmd[0] == 0xa0 and (cmd[1] & (3 << 6)) == (0 << 6):
            self.handle_cmd_read_eeprom_memory(cmd, ret)
        elif (cmd[0] == 0x20 or cmd[0] == 0x28) and ((cmd[1] & 0xf0) == 0x00):
            self.handle_cmd_read_program_memory(cmd, ret)
        elif (cmd[0] == 0x40 or cmd[0] == 0x48) and ((cmd[1] & 0xf0) == 0x00):
            self.handle_cmd_load_program_memory_page(cmd, ret)
        elif (cmd[0] == 0x4C and ((cmd[1] & 0xf0) == 0x00)):
            self.handle_cmd_write_program_memory_page(cmd, ret)
        else:
            c = '%02x %02x %02x %02x' % tuple(cmd)
            r = '%02x %02x %02x %02x' % tuple(ret)
            self.putx([Ann.WARN, ['Unknown command: %s (reply: %s)!' % (c, r)]])

    def decode(self, ss, es, data):
        ptype, mosi, miso = data

        # For now, only use DATA and BITS packets.
        if ptype not in ('DATA', 'BITS'):
            return

        # Store the individual bit values and ss/es numbers. The next packet
        # is guaranteed to be a 'DATA' packet belonging to this 'BITS' one.
        if ptype == 'BITS':
            self.miso_bits, self.mosi_bits = miso, mosi
            return

        self.ss, self.es = ss, es

        if len(self.mosi_bytes) == 0:
            self.ss_cmd = ss

        # Append new bytes.
        self.mosi_bytes.append(mosi)
        self.miso_bytes.append(miso)

        # All commands consist of 4 bytes.
        if len(self.mosi_bytes) < 4:
            return

        self.es_cmd = es

        self.handle_command(self.mosi_bytes, self.miso_bytes)

        self.mosi_bytes = []
        self.miso_bytes = []
Commit	Line	Data
3bd76451	1	##
50bd5d25	2	## This file is part of the libsigrokdecode project.
3bd76451	3	##
ad30cb46	4	## Copyright (C) 2012-2014 Uwe Hermann <uwe@hermann-uwe.de>
3bd76451 UH	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
4539e9ca	17	## along with this program; if not, see <http://www.gnu.org/licenses/>.
3bd76451 UH	18	##
3bd76451 UH	19
3bd76451	20	import sigrokdecode as srd
77adad94	21	from .parts import *
3bd76451	22
f5250c60 HK	23	class Ann:
f5250c60 HK	24	PE, RSB0, RSB1, RSB2, CE, RFB, RHFB, REFB, \
296c29a3	25	RLB, REEM, RP, LPMP, WP, WARN, DEV, = range(15)
f5250c60	26
3bd76451 UH	27	VENDOR_CODE_ATMEL = 0x1e
	28
	29	class Decoder(srd.Decoder):
b197383c	30	api_version = 3
3bd76451 UH	31	id = 'avr_isp'
3bd76451 UH	32	name = 'AVR ISP'
d523eae6	33	longname = 'AVR In-System Programming'
2787cf2a	34	desc = 'Atmel AVR In-System Programming (ISP) protocol.'
3bd76451	35	license = 'gplv2+'
4e4f8527	36	inputs = ['spi']
6cbba91f	37	outputs = []
d6d8a8a4	38	tags = ['Debug/trace']
da9bcbd9 BV	39	annotations = (
	40	('pe', 'Programming enable'),
	41	('rsb0', 'Read signature byte 0'),
	42	('rsb1', 'Read signature byte 1'),
	43	('rsb2', 'Read signature byte 2'),
	44	('ce', 'Chip erase'),
	45	('rfb', 'Read fuse bits'),
	46	('rhfb', 'Read high fuse bits'),
	47	('refb', 'Read extended fuse bits'),
296c29a3 HK	48	('rlb', 'Read lock bits'),
	49	('reem', 'Read EEPROM memory'),
	50	('rp', 'Read program memory'),
	51	('lpmp' , 'Load program memory page'),
	52	('wp', 'Write program memory'),
e144452b	53	('warning', 'Warning'),
da9bcbd9 BV	54	('dev', 'Device'),
da9bcbd9 BV	55	)
3b001341	56	annotation_rows = (
f5250c60	57	('commands', 'Commands', (Ann.PE, Ann.RSB0, Ann.RSB1, Ann.RSB2,
296c29a3 HK	58	Ann.CE, Ann.RFB, Ann.RHFB, Ann.REFB,
296c29a3 HK	59	Ann.RLB, Ann.REEM, Ann.RP, Ann.LPMP, Ann.WP,)),
f5250c60 HK	60	('warnings', 'Warnings', (Ann.WARN,)),
f5250c60 HK	61	('devs', 'Devices', (Ann.DEV,)),
3b001341	62	)
3bd76451	63
92b7b49f	64	def __init__(self):
10aeb8ea GS	65	self.reset()
	66
	67	def reset(self):
3bd76451 UH	68	self.state = 'IDLE'
3bd76451 UH	69	self.mosi_bytes, self.miso_bytes = [], []
486b19ce	70	self.ss_cmd, self.es_cmd = 0, 0
3bd76451	71	self.xx, self.yy, self.zz, self.mm = 0, 0, 0, 0
486b19ce	72	self.ss_device = None
3bd76451	73
8915b346	74	def start(self):
be465111	75	self.out_ann = self.register(srd.OUTPUT_ANN)
3bd76451	76
3bd76451	77	def putx(self, data):
486b19ce	78	self.put(self.ss_cmd, self.es_cmd, self.out_ann, data)
3bd76451 UH	79
	80	def handle_cmd_programming_enable(self, cmd, ret):
	81	# Programming enable.
	82	# Note: The chip doesn't send any ACK for 'Programming enable'.
f5250c60	83	self.putx([Ann.PE, ['Programming enable']])
3bd76451 UH	84
	85	# Sanity check on reply.
	86	if ret[1:4] != [0xac, 0x53, cmd[2]]:
f5250c60	87	self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])
3bd76451 UH	88
	89	def handle_cmd_read_signature_byte_0x00(self, cmd, ret):
	90	# Signature byte 0x00: vendor code.
	91	self.vendor_code = ret[3]
	92	v = vendor_code[self.vendor_code]
f5250c60	93	self.putx([Ann.RSB0, ['Vendor code: 0x%02x (%s)' % (ret[3], v)]])
3bd76451 UH	94
	95	# Store for later.
	96	self.xx = cmd[1] # Same as ret[2].
	97	self.yy = cmd[3]
	98	self.zz = ret[0]
	99
	100	# Sanity check on reply.
	101	if ret[1] != 0x30 or ret[2] != cmd[1]:
f5250c60	102	self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])
3bd76451 UH	103
	104	# Sanity check for the vendor code.
	105	if self.vendor_code != VENDOR_CODE_ATMEL:
f5250c60	106	self.putx([Ann.WARN, ['Warning: Vendor code was not 0x1e (Atmel)!']])
3bd76451 UH	107
	108	def handle_cmd_read_signature_byte_0x01(self, cmd, ret):
	109	# Signature byte 0x01: part family and memory size.
	110	self.part_fam_flash_size = ret[3]
f5250c60	111	self.putx([Ann.RSB1, ['Part family / memory size: 0x%02x' % ret[3]]])
3bd76451 UH	112
	113	# Store for later.
	114	self.mm = cmd[3]
486b19ce	115	self.ss_device = self.ss_cmd
3bd76451 UH	116
	117	# Sanity check on reply.
	118	if ret[1] != 0x30 or ret[2] != cmd[1] or ret[0] != self.yy:
f5250c60	119	self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])
3bd76451 UH	120
	121	def handle_cmd_read_signature_byte_0x02(self, cmd, ret):
	122	# Signature byte 0x02: part number.
	123	self.part_number = ret[3]
f5250c60	124	self.putx([Ann.RSB2, ['Part number: 0x%02x' % ret[3]]])
3bd76451	125
3bd76451	126	p = part[(self.part_fam_flash_size, self.part_number)]
f5250c60	127	data = [Ann.DEV, ['Device: Atmel %s' % p]]
486b19ce	128	self.put(self.ss_device, self.es_cmd, self.out_ann, data)
3bd76451 UH	129
	130	# Sanity check on reply.
	131	if ret[1] != 0x30 or ret[2] != self.xx or ret[0] != self.mm:
f5250c60	132	self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])
3bd76451 UH	133
	134	self.xx, self.yy, self.zz, self.mm = 0, 0, 0, 0
	135
	136	def handle_cmd_chip_erase(self, cmd, ret):
1fd698dc UH	137	# Chip erase (erases both flash an EEPROM).
	138	# Upon successful chip erase, the lock bits will also be erased.
	139	# The only way to end a Chip Erase cycle is to release RESET#.
f5250c60	140	self.putx([Ann.CE, ['Chip erase']])
3bd76451	141
1fd698dc UH	142	# TODO: Check/handle RESET#.
	143
	144	# Sanity check on reply.
	145	bit = (ret[2] & (1 << 7)) >> 7
	146	if ret[1] != 0xac or bit != 1 or ret[3] != cmd[2]:
f5250c60	147	self.putx([Ann.WARN, ['Warning: Unexpected bytes in reply!']])
1fd698dc	148
3bd76451 UH	149	def handle_cmd_read_fuse_bits(self, cmd, ret):
3bd76451 UH	150	# Read fuse bits.
f5250c60	151	self.putx([Ann.RFB, ['Read fuse bits: 0x%02x' % ret[3]]])
3bd76451 UH	152
	153	# TODO: Decode fuse bits.
	154	# TODO: Sanity check on reply.
	155
	156	def handle_cmd_read_fuse_high_bits(self, cmd, ret):
	157	# Read fuse high bits.
f5250c60	158	self.putx([Ann.RHFB, ['Read fuse high bits: 0x%02x' % ret[3]]])
3bd76451 UH	159
	160	# TODO: Decode fuse bits.
	161	# TODO: Sanity check on reply.
	162
	163	def handle_cmd_read_extended_fuse_bits(self, cmd, ret):
	164	# Read extended fuse bits.
f5250c60	165	self.putx([Ann.REFB, ['Read extended fuse bits: 0x%02x' % ret[3]]])
3bd76451 UH	166
	167	# TODO: Decode fuse bits.
	168	# TODO: Sanity check on reply.
	169
296c29a3 HK	170	def handle_cmd_read_lock_bits(self, cmd, ret):
	171	# Read lock bits
	172	self.putx([Ann.RLB, ['Read lock bits: 0x%02x' % ret[3]]])
	173
	174	def handle_cmd_read_eeprom_memory(self, cmd, ret):
	175	# Read EEPROM Memory
	176	_addr = ((cmd[1] & 1) << 8) + cmd[2]
	177	self.putx([Ann.REEM, ['Read EEPROM Memory: [0x%03x]: 0x%02x' % (_addr, ret[3])]])
	178
	179	def handle_cmd_read_program_memory(self, cmd, ret):
	180	# Read Program Memory
	181	_HL = 'Low'
	182	_H = 'L'
	183	if cmd[0] & 0x08:
	184	_HL = 'High'
	185	_H = 'H'
	186	_addr = ((cmd[1] & 0x0f) << 8) + cmd[2]
	187	self.putx([Ann.RP, [
	188	'Read program memory %s: [0x%03x]: 0x%02x' % (_HL, _addr, ret[3]),
	189	'[%03x%s]:%02x' % (_addr, _H, ret[3]),
	190	'%02x' % ret[3]
	191	]])
	192
	193	def handle_cmd_load_program_memory_page(self, cmd, ret):
	194	# Load Program Memory Page
	195	_HL = 'Low'
	196	_H = 'L'
	197	if cmd[0] & 0x08:
	198	_HL = 'High'
	199	_H = 'H'
	200	_addr = cmd[2] & 0x1F
	201	self.putx([Ann.LPMP, [
	202	'Load program memory page %s: [0x%03x]: 0x%02x' % (_HL, _addr, cmd[3]),
	203	'[%03x%s]=%02x' % (_addr, _H, cmd[3]),
	204	'%02x' % cmd[3]
	205	]])
	206
	207	def handle_cmd_write_program_memory_page(self, cmd, ret):
	208	# Write Program Memory Page
	209	_addr = ((cmd[1] & 0x0F) << 3) + (cmd[2] << 5)
	210	self.putx([Ann.WP, ['Write program memory page: 0x%02x' % _addr]])
	211
3bd76451 UH	212	def handle_command(self, cmd, ret):
	213	if cmd[:2] == [0xac, 0x53]:
	214	self.handle_cmd_programming_enable(cmd, ret)
	215	elif cmd[0] == 0xac and (cmd[1] & (1 << 7)) == (1 << 7):
	216	self.handle_cmd_chip_erase(cmd, ret)
	217	elif cmd[:3] == [0x50, 0x00, 0x00]:
	218	self.handle_cmd_read_fuse_bits(cmd, ret)
	219	elif cmd[:3] == [0x58, 0x08, 0x00]:
	220	self.handle_cmd_read_fuse_high_bits(cmd, ret)
	221	elif cmd[:3] == [0x50, 0x08, 0x00]:
	222	self.handle_cmd_read_extended_fuse_bits(cmd, ret)
	223	elif cmd[0] == 0x30 and cmd[2] == 0x00:
	224	self.handle_cmd_read_signature_byte_0x00(cmd, ret)
	225	elif cmd[0] == 0x30 and cmd[2] == 0x01:
	226	self.handle_cmd_read_signature_byte_0x01(cmd, ret)
	227	elif cmd[0] == 0x30 and cmd[2] == 0x02:
	228	self.handle_cmd_read_signature_byte_0x02(cmd, ret)
296c29a3 HK	229	elif cmd[:2] == [0x58, 0x00]:
	230	self.handle_cmd_read_lock_bits(cmd,ret)
	231	elif cmd[0] == 0xa0 and (cmd[1] & (3 << 6)) == (0 << 6):
	232	self.handle_cmd_read_eeprom_memory(cmd, ret)
	233	elif (cmd[0] == 0x20 or cmd[0] == 0x28) and ((cmd[1] & 0xf0) == 0x00):
	234	self.handle_cmd_read_program_memory(cmd, ret)
	235	elif (cmd[0] == 0x40 or cmd[0] == 0x48) and ((cmd[1] & 0xf0) == 0x00):
	236	self.handle_cmd_load_program_memory_page(cmd, ret)
	237	elif (cmd[0] == 0x4C and ((cmd[1] & 0xf0) == 0x00)):
	238	self.handle_cmd_write_program_memory_page(cmd, ret)
3bd76451 UH	239	else:
	240	c = '%02x %02x %02x %02x' % tuple(cmd)
	241	r = '%02x %02x %02x %02x' % tuple(ret)
3f2a4616	242	self.putx([Ann.WARN, ['Unknown command: %s (reply: %s)!' % (c, r)]])
3bd76451 UH	243
	244	def decode(self, ss, es, data):
	245	ptype, mosi, miso = data
	246
ad30cb46 UH	247	# For now, only use DATA and BITS packets.
ad30cb46 UH	248	if ptype not in ('DATA', 'BITS'):
3bd76451 UH	249	return
3bd76451 UH	250
ad30cb46 UH	251	# Store the individual bit values and ss/es numbers. The next packet
	252	# is guaranteed to be a 'DATA' packet belonging to this 'BITS' one.
	253	if ptype == 'BITS':
	254	self.miso_bits, self.mosi_bits = miso, mosi
	255	return
3bd76451 UH	256
	257	self.ss, self.es = ss, es
	258
011ed1a3	259	if len(self.mosi_bytes) == 0:
486b19ce	260	self.ss_cmd = ss
011ed1a3	261
3bd76451 UH	262	# Append new bytes.
	263	self.mosi_bytes.append(mosi)
	264	self.miso_bytes.append(miso)
	265
3bd76451 UH	266	# All commands consist of 4 bytes.
	267	if len(self.mosi_bytes) < 4:
	268	return
	269
486b19ce	270	self.es_cmd = es
3bd76451 UH	271
	272	self.handle_command(self.mosi_bytes, self.miso_bytes)
	273
	274	self.mosi_bytes = []
	275	self.miso_bytes = []