3 # Utility to decode register values
4 # Copyright (c) 2006 Jeremy Kerr <jk@ozlabs.org>
5 # Released under the GNU General Public License version 2 or later
7 # Documentation and updates at: http://ozlabs.org/~jk/code/bitfield
12 from pyparsing import Literal, Word, ZeroOrMore, Group, Dict, Optional, \
13 printables, ParseException, restOfLine
14 from getopt import getopt, GetoptError
16 # List of paths to look for configuration files. If a directory is specified,
17 # it will be (recursively) scanned for .conf files.
18 configs = ["/etc/bitfield.d", "/etc/bitfield",
19 os.path.join(os.getenv("HOME"), ".bitfield.d"),
20 os.path.join(os.getenv("HOME"), ".bitfield.conf")]
23 def __init__(self, bits, name):
31 def add_value(self, value, description):
32 self.values[int(value)] = description
34 def mask(self, reg_width, value):
36 out_len = len(self.bits)
37 for out_bit in range(0, out_len):
38 in_bit = self.bits[out_bit]
39 # shift this bit down to the LSB (and mask the rest)
40 i = (value >> (reg_width - in_bit - 1)) & 1
41 # shift back to the output position in the field
42 i <<= out_len - out_bit - 1
46 def value(self, value):
47 if value in self.values:
48 return self.values[value]
52 def mask_and_shift_to_bits(width, mask, shift):
55 for i in range(0, width):
57 bits.insert(0, width - i - 1 - shift)
61 def mask_to_bits(width, mask):
62 return bitfield.mask_and_shift_to_bits(width, mask, 0)
65 def parse_bitfield(line, reg):
66 a = line.split(None, 1)
72 for s in range_str.split(','):
75 lambda s: reg.bit_number(int(s)),
77 start = reg.bit_number(int(start))
78 end = reg.bit_number(int(end))
79 bits.extend(range(start, end + 1, 1))
81 (mask, shift) = map(lambda s: int(s.strip()),
83 bits.extend(bitfield.mask_and_shift_to_bits( \
84 reg.width, mask, shift))
85 elif s.startswith('&'):
87 bits.extend(bitfield.mask_to_bits(reg.width, \
90 bits.append(reg.bit_number(int(s)))
92 return bitfield(bits, name)
97 def parse_value(line):
98 a = line.split(None, 1)
107 def __init__(self, id):
112 self.bit_order = self.bit_0_is_msb
115 def add_field(self, field):
116 self.fields.append(field)
118 def decode(self, value, ignore_zero):
119 field_width = (self.width + 3) / 4
120 name_width = max(map(lambda f: len(f.name), self.fields))
122 str = "0x%0*lx [%d]\n" % (field_width, value, value)
124 for field in self.fields:
125 v = field.mask(self.width, value);
126 if ignore_zero and v == 0:
128 desc = field.value(v)
130 str += "%*s: 0x%x [%s]\n" \
131 % (name_width, field.name, v, desc)
133 str += "%*s: 0x%x\n" \
134 % (name_width, field.name, v)
137 def bit_number(self, number):
138 if self.bit_order == self.bit_0_is_lsb:
139 number = self.width - 1 - number
143 for (id, r) in regs.iteritems():
144 print "%18s : %s" % (id, r.name)
146 def search_regs(regs, str):
147 return dict((k, regs[k]) for k in regs \
148 if str.lower() in regs[k].name.lower() + k.lower())
150 class ConfigurationError(Exception):
151 def __init__(self, file, message):
153 self.message = message
155 def parse_config(bnf, regs, file):
158 tokens = bnf.parseString(f.read())
160 order_map = {'bit-0-is-lsb': register.bit_0_is_lsb,
161 'bit-0-is-msb': register.bit_0_is_msb,
162 'ibm': register.bit_0_is_msb,
163 'default': register.bit_0_is_msb}
170 raise ConfigurationError(file,
171 "Register %s is already defined" % id)
181 reg.name = name.strip()
182 elif t[0] == 'width':
183 reg.width = int(t[1])
184 elif t[0] == 'field':
185 f = bitfield.parse_bitfield(t[1], reg)
187 raise ConfigurationError(file,
188 "Invalid field in %s" % id)
190 elif t[0] == 'value':
192 raise ConfigurationError(file,
193 "No field for value in %s" % id)
194 v = bitfield.parse_value(t[1])
196 raise ConfigurationError(file,
197 "Invalid value in %s" % id)
199 fields[-1].add_value(v[0], v[1])
200 elif t[0] == 'order':
202 raise ConfigurationError(file,
203 ("bit order defined after " \
204 + "fields in %s") % id)
206 order_str = t[1].strip().lower()
207 order_str = order_str.replace(' ', '-')
209 if order_str not in order_map.keys():
210 raise ConfigurationError(file,
211 "Invalid bit order %s in %s" % \
213 reg.bit_order = order_map[order_str]
215 elif t[0] == 'alias':
216 alias_id = t[1].strip()
218 if alias_id is not None:
219 if reg.name is not None or fields != []:
220 raise ConfigurationError(file, ("Definiton " \
221 + "for %s is an alias, but has other " \
222 + "attributes") % id)
224 if not regs.has_key(alias_id):
225 raise ConfigurationError(file, "Aliasing "
226 "non-existent register %s (from %s)" \
232 if reg.name is None or reg.name == '':
233 raise ConfigurationError(file,
234 "No name for entry %s" % id)
237 raise ConfigurationError(file,
238 "Register %s has no fields" % id)
245 def parse_config_dir(data, dir, fnames):
248 full_fname = os.path.join(dir, fname)
250 if os.path.isdir(full_fname):
253 if fname.endswith('.conf'):
254 parse_config(bnf, regs, full_fname)
256 def parse_all_configs(configs):
259 # set up the bnf to be used for each file
260 lbrack = Literal("[").suppress()
261 rbrack = Literal("]").suppress()
262 colon = Literal(":").suppress()
265 comment = semi + Optional(restOfLine)
267 nonrbrack = "".join([c for c in printables if c != "]"]) + " \t"
268 noncolon = "".join([c for c in printables if c != ":"]) + " \t"
270 sectionDef = lbrack + Word(nonrbrack) + rbrack
271 keyDef = ~lbrack + Word(noncolon) + colon + restOfLine
273 bnf = Dict(ZeroOrMore(Group(sectionDef + ZeroOrMore(Group(keyDef)))))
276 # bundle into a single var that can be passed to os.path.walk
277 conf_data = (bnf, regs)
280 if not os.path.exists(conf):
282 if os.path.isdir(conf):
283 os.path.walk(conf, parse_config_dir, conf_data)
285 parse_config(bnf, regs, conf)
289 print "Usage: %s <-l> | <-s pattern> | [-n] register [value...]" % prog
291 def decode_value(reg, value, options):
294 except ValueError, e:
295 print "error: invalid value '%s'" % value
298 if i > ((1 << reg.width) - 1):
299 print ("error: value '%s' is too large " + \
300 "for %d-bit register '%s'") % (value, reg.width, reg.id)
303 print reg.decode(i, options['non-zero'])
308 (opts, args) = getopt(sys.argv[1:], "hlns:", \
309 ["help", "list", "non-zero", "search="])
315 regs = parse_all_configs(configs)
316 except ConfigurationError, e:
317 print "Error parsing configuration file %s:\n\t%s" % \
322 print "No configuration available"
326 options['non-zero'] = False
329 if o in ("-h", "--help"):
333 if o in ("-l", "--list"):
337 if o in ("-s", "--search"):
338 list_regs(search_regs(regs, a))
341 if o in ("-n", "--non-zero"):
342 options['non-zero'] = True
349 if not regs.has_key(reg_id):
350 print "No such register '%s'" % reg_id
354 print "decoding as %s" % reg.name
357 value_iter = args.__iter__()
359 value_iter = iter(sys.stdin.readline, '')
362 for value in value_iter:
363 decode_value(reg, value.strip(), options)
364 except KeyboardInterrupt, e:
369 if __name__ == "__main__":