Ardupilot2/Tools/scripts/decode-ICSR.py

#!/usr/bin/env python
'''
decode an stm32 ICSR register value
'''

import sys
import optparse


def num(s):
    try:
        return int(s)
    except ValueError:
        return int(s, 16)


parser = optparse.OptionParser(__file__)

opts, args = parser.parse_args()

if len(args) == 0:
    print(parser.usage)
    sys.exit(0)

ICSR = num(args[0])

# https://www.st.com/content/ccc/resource/technical/document/programming_manual/6c/3a/cb/e7/e4/ea/44/9b/DM00046982.pdf/files/DM00046982.pdf/jcr:content/translations/en.DM00046982.pdf
# page 225


def decoder_m4_vectactive(value):
    exceptions = {
        0: "Thread mode",
        1: "Reserved",
        2: "NMI",
        3: "Hard fault",
        4: "Memory management fault",
        5: "Bus fault",
        6: "Usage fault",
        7: "Reserved....",
        10: "Reserved",
        11: "SVCall",
        12: "Reserved for Debug",
        13: "Reserved",
        14: "PendSV",
        15: "SysTick",
    }
    if value in exceptions:
        exception = "%s" % str(exceptions[value])
    else:
        exception = "IRQ%u" % (value - 16)

    sys.stdout.write(" (%s)" % exception)

def decoder_m4_retobase(value):
    if value:
        out = "no (or no more) active exceptions"
    else:
        out = "preempted active exceptions"
    sys.stdout.write(" (%s)" % out)

def decoder_m4_vectpending(value):
    return decoder_m4_vectactive(value)

def decoder_m4_isrpending(value):
    if value:
        out = "Interrupt pending"
    else:
        out = "No pending interupt"
    sys.stdout.write(" (%s)" % out)

def decoder_m4_pendstclr(value):
    sys.stdout.write(" (WO clears SysTick exception)")

def decoder_m4_pendstset(value):
    if value:
        out = "SysTick pending"
    else:
        out = "SysTick not pending"
    sys.stdout.write(" (%s)" % out)

def decoder_m4_pendsvclr(value):
    sys.stdout.write(" (WO clears pendsv exception)")

def decoder_m4_pendsvset(value):
    if value:
        out = "PendSV pending"
    else:
        out = "PendSV not pending"
    sys.stdout.write(" (%s)" % out)

def decoder_m4_nmipendset(value):
    if value:
        out = "NMI pending"
    else:
        out = "NMI not pending"
    sys.stdout.write(" (%s)" % out)

# this ICSR-bit-assignment-table table also looks valid for M7 - page 195 of dm00237416-stm32f7-series-and-stm32h7-series-cortexm7-processor-programming-manual-stmicroelectronics.pdf
M4_BITS = [
    ("0-8", "VECTACTIVE", decoder_m4_vectactive),
    ("9-10", "RESERVED1", None),
    ("11", "RETOBASE", decoder_m4_retobase),
    ("12-18", "VECTPENDING", decoder_m4_vectpending),
    ("19-21", "RESERVED2", None),
    ("22", "ISRPENDING", decoder_m4_isrpending),
    ("23-24", "RESERVED3", None),
    ("25", "PENDSTCLR", decoder_m4_pendstclr),
    ("26", "PENDSTSET", decoder_m4_pendstset),
    ("27", "PENDSVCLR", decoder_m4_pendsvclr),
    ("28", "PENDSVSET", decoder_m4_pendstset),
    ("29-30", "RESERVED4", None),
    ("31", "NMIPENDSET", decoder_m4_nmipendset),
]

longest_name_length = 0
for bit in M4_BITS:
    (bits, name, decoder) = bit
    length = len(name)
    if length > longest_name_length:
        longest_name_length = length

complete_mask = 0

for bit in M4_BITS:
    (bits, name, decoder) = bit
    if "-" in bits:
        (start_bit, stop_bit) = bits.split("-")
        start_bit = int(start_bit)
        stop_bit = int(stop_bit)
    else:
        start_bit = int(bits)
        stop_bit = int(bits)
    mask = 0
    for i in range(start_bit, stop_bit+1):
        mask |= (1 << i)
        complete_mask |= mask
    value = (ICSR & mask) >> start_bit
    _format = "%%%us: %%3u " % (longest_name_length,)
    sys.stdout.write(_format % (name, value)),
    if decoder is not None:
        decoder(value)
    print("")

if complete_mask != 0b11111111111111111111111111111111:
    raise Exception("Mask incomplete")