]> rtime.felk.cvut.cz Git - jailhouse.git/blob - tools/jailhouse-config-create
tools: Implement ACPI IVRS table parser
[jailhouse.git] / tools / jailhouse-config-create
1 #!/usr/bin/env python
2 #
3 # Jailhouse, a Linux-based partitioning hypervisor
4 #
5 # Copyright (c) Siemens AG, 2014
6 #
7 # This work is licensed under the terms of the GNU GPL, version 2.  See
8 # the COPYING file in the top-level directory.
9 #
10 # This script should help to create a basic jailhouse configuration file.
11 # It needs to be executed on the target machine, where it will gather
12 # information about the system. For more advanced scenarios you will have
13 # to change the generated C-code.
14
15 from __future__ import print_function
16 import sys
17 import os
18 import re
19 import argparse
20 import struct
21 import fnmatch
22 from mako.template import Template
23
24 datadir = None
25
26 if datadir:
27     template_default_dir = datadir + "/jailhouse"
28 else:
29     template_default_dir = os.path.abspath(os.path.dirname(sys.argv[0]))
30
31 cpuvendor = None
32
33 # pretend to be part of the jailhouse tool
34 sys.argv[0] = sys.argv[0].replace('-', ' ')
35
36 parser = argparse.ArgumentParser()
37 parser.add_argument('-g', '--generate-collector',
38                     help='generate a script to collect input files on '
39                          'a remote machine',
40                     action='store_true')
41 parser.add_argument('-r', '--root',
42                     help='gather information in ROOT/, the default is "/" '
43                          'which means creating a config for localhost',
44                     default='/',
45                     action='store',
46                     type=str)
47 parser.add_argument('-t', '--template-dir',
48                     help='the directory where the templates are located,'
49                          'the default is "' + template_default_dir + '"',
50                     default=template_default_dir,
51                     action='store',
52                     type=str)
53
54 memargs = [['--mem-inmates', '2M', 'inmate'],
55            ['--mem-hv', '64M', 'hypervisor']]
56
57 for entry in memargs:
58     parser.add_argument(entry[0],
59                         help='the amount of ' + entry[2] +
60                              ' memory, default is "' + entry[1] +
61                              '", format "xxx[K|M|G]"',
62                         default=entry[1],
63                         action='store',
64                         type=str)
65
66 parser.add_argument('file', metavar='FILE',
67                     help='name of file to write out',
68                     type=str)
69
70 options = parser.parse_args()
71
72 inputs = {
73     'files': set(),
74     'files_opt': set(),
75     'files_intel': set(),
76     'files_amd': set()
77 }
78
79 # required files
80 inputs['files'].add('/proc/iomem')
81 inputs['files'].add('/proc/cpuinfo')
82 inputs['files'].add('/proc/cmdline')
83 inputs['files'].add('/proc/ioports')
84 inputs['files'].add('/sys/bus/pci/devices/*/config')
85 inputs['files'].add('/sys/devices/system/cpu/cpu*/uevent')
86 inputs['files'].add('/sys/firmware/acpi/tables/APIC')
87 inputs['files'].add('/sys/firmware/acpi/tables/MCFG')
88 # optional files
89 inputs['files_opt'].add('/sys/class/dmi/id/product_name')
90 inputs['files_opt'].add('/sys/class/dmi/id/sys_vendor')
91 inputs['files_opt'].add('/sys/devices/jailhouse/enabled')
92 # platform specific files
93 inputs['files_intel'].add('/sys/firmware/acpi/tables/DMAR')
94 inputs['files_amd'].add('/sys/firmware/acpi/tables/IVRS')
95
96
97 def kmg_multiply(value, kmg):
98     if (kmg == 'K' or kmg == 'k'):
99         return 1024 * value
100     if (kmg == 'M' or kmg == 'm'):
101         return 1024**2 * value
102     if (kmg == 'G' or kmg == 'g'):
103         return 1024**3 * value
104     return value
105
106
107 def kmg_multiply_str(str):
108     m = re.match(r'([0-9a-fA-FxX]+)([KMG]?)', str)
109     if m is not None:
110         return kmg_multiply(int(m.group(1)), m.group(2))
111     raise RuntimeError('kmg_multiply_str can not parse input "' + str + '"')
112
113
114 def check_input_listed(name, optional=False):
115     set = inputs['files_opt']
116     if optional is False:
117         set = inputs['files']
118         global cpuvendor
119         if cpuvendor == 'GenuineIntel':
120             set = set.union(inputs['files_intel'])
121         elif cpuvendor == 'AuthenticAMD':
122             set = set.union(inputs['files_amd'])
123
124     for file in set:
125         if fnmatch.fnmatch(name, file):
126             return True
127     raise RuntimeError('"' + name + '" is not a listed input file')
128
129
130 def input_open(name, mode='r', optional=False):
131     check_input_listed(name, optional)
132     try:
133         f = open(options.root + name, mode)
134     except Exception as e:
135         if optional:
136             return open("/dev/null", mode)
137         raise e
138     return f
139
140
141 def input_readline(name, optional=False):
142     f = input_open(name, optional=optional)
143     line = f.readline()
144     f.close()
145     return line
146
147
148 def input_listdir(dir, wildcards):
149     for w in wildcards:
150         check_input_listed(os.path.join(dir, w))
151     dirs = os.listdir(options.root + dir)
152     dirs.sort()
153     return dirs
154
155
156 class PCICapability:
157     def __init__(self, id, start, len, flags, content, msix_address):
158         self.id = id
159         self.start = start
160         self.len = len
161         self.flags = flags
162         self.content = content
163         self.msix_address = msix_address
164         self.comments = []
165
166     def __eq__(self, other):
167         return self.id == other.id and self.start == other.start and \
168             self.len == other.len and self.flags == other.flags
169
170     RD = '0'
171     RW = 'JAILHOUSE_PCICAPS_WRITE'
172
173     @staticmethod
174     def parse_pcicaps(dir):
175         caps = []
176         f = input_open(os.path.join(dir, 'config'), 'rb')
177         f.seek(0x06)
178         (status,) = struct.unpack('<H', f.read(2))
179         # capability list supported?
180         if (status & (1 << 4)) == 0:
181             f.close()
182             return caps
183         # walk capability list
184         f.seek(0x34)
185         (next,) = struct.unpack('B', f.read(1))
186         while next != 0:
187             cap = next
188             msix_address = 0
189             f.seek(cap)
190             (id, next) = struct.unpack('<BB', f.read(2))
191             if id == 0x01:  # Power Management
192                 # this cap can be handed out completely
193                 len = 8
194                 flags = PCICapability.RW
195             elif id == 0x05:  # MSI
196                 # access will be moderated by hypervisor
197                 len = 10
198                 (msgctl,) = struct.unpack('<H', f.read(2))
199                 if (msgctl & (1 << 7)) != 0:  # 64-bit support
200                     len += 4
201                 if (msgctl & (1 << 8)) != 0:  # per-vector masking support
202                     len += 10
203                 flags = PCICapability.RW
204             elif id == 0x11:  # MSI-X
205                 # access will be moderated by hypervisor
206                 len = 12
207                 (table,) = struct.unpack('<xxI', f.read(6))
208                 f.seek(0x10 + (table & 7) * 4)
209                 (bar,) = struct.unpack('<I', f.read(4))
210                 if (bar & 0x3) != 0:
211                     raise RuntimeError('Invalid MSI-X BAR found')
212                 if (bar & 0x4) != 0:
213                     bar |= struct.unpack('<I', f.read(4))[0] << 32
214                 msix_address = (bar & 0xfffffffffffffff0) + table & 0xfffffff8
215                 flags = PCICapability.RW
216             else:
217                 # unknown/unhandled cap, mark its existence
218                 len = 2
219                 flags = PCICapability.RD
220             f.seek(cap + 2)
221             content = f.read(len - 2)
222             caps.append(PCICapability(id, cap, len, flags, content,
223                                       msix_address))
224         f.close()
225         return caps
226
227
228 class PCIDevice:
229     def __init__(self, type, domain, bus, dev, fn, caps, path):
230         self.type = type
231         self.iommu = None
232         self.domain = domain
233         self.bus = bus
234         self.dev = dev
235         self.fn = fn
236         self.caps = caps
237         self.path = path
238         self.caps_start = 0
239         self.num_caps = len(caps)
240         self.num_msi_vectors = 0
241         self.msi_64bits = 0
242         self.num_msix_vectors = 0
243         self.msix_region_size = 0
244         self.msix_address = 0
245         for c in caps:
246             if c.id in (0x05, 0x11):
247                 msg_ctrl = struct.unpack('<H', c.content[:2])[0]
248                 if c.id == 0x05:  # MSI
249                     self.num_msi_vectors = 1 << ((msg_ctrl >> 1) & 0x7)
250                     self.msi_64bits = (msg_ctrl >> 7) & 1
251                 else:  # MSI-X
252                     vectors = (msg_ctrl & 0x7ff) + 1
253                     self.num_msix_vectors = vectors
254                     self.msix_region_size = (vectors * 16 + 0xfff) & 0xf000
255                     self.msix_address = c.msix_address
256
257     def __str__(self):
258         return 'PCIDevice: %02x:%02x.%x' % (self.bus, self.dev, self.fn)
259
260     def bdf(self):
261         return self.bus << 8 | self.dev << 3 | self.fn
262
263     @staticmethod
264     def parse_pcidevice_sysfsdir(basedir, dir):
265         dpath = os.path.join(basedir, dir)
266         f = input_open(os.path.join(dpath, 'config'), 'rb')
267         f.seek(0x0A)
268         (classcode,) = struct.unpack('<H', f.read(2))
269         f.close()
270         if classcode == 0x0604:
271             type = 'JAILHOUSE_PCI_TYPE_BRIDGE'
272         else:
273             type = 'JAILHOUSE_PCI_TYPE_DEVICE'
274         a = dir.split(':')
275         domain = int(a[0], 16)
276         bus = int(a[1], 16)
277         df = a[2].split('.')
278         caps = PCICapability.parse_pcicaps(dpath)
279         return PCIDevice(type, domain, bus, int(df[0], 16), int(df[1], 16),
280                          caps, dpath)
281
282
283 class PCIPCIBridge(PCIDevice):
284     @staticmethod
285     def get_2nd_busses(dev):
286         assert dev.type == 'JAILHOUSE_PCI_TYPE_BRIDGE'
287         f = input_open(os.path.join(dev.path, 'config'), 'rb')
288         f.seek(0x19)
289         (secondbus, subordinate) = struct.unpack('<BB', f.read(2))
290         f.close()
291         return (secondbus, subordinate)
292
293
294 class MemRegion:
295     def __init__(self, start, stop, typestr, comments=None):
296         self.start = start
297         self.stop = stop
298         self.typestr = typestr
299         if comments is None:
300             self.comments = []
301         else:
302             self.comments = comments
303
304     def __str__(self):
305         return 'MemRegion: %08x-%08x : %s' % \
306             (self.start, self.stop, self.typestr)
307
308     def size(self):
309         # round up to full PAGE_SIZE
310         return int((self.stop - self.start + 0xfff) / 0x1000) * 0x1000
311
312     def flagstr(self, p=''):
313         if (
314             self.typestr == 'System RAM' or
315             self.typestr == 'Kernel' or
316             self.typestr == 'RAM buffer' or
317             self.typestr == 'ACPI DMAR RMRR' or
318             self.typestr == 'ACPI IVRS'
319         ):
320             s = 'JAILHOUSE_MEM_READ | JAILHOUSE_MEM_WRITE |\n'
321             s += p + '\t\tJAILHOUSE_MEM_EXECUTE | JAILHOUSE_MEM_DMA'
322             return s
323         return 'JAILHOUSE_MEM_READ | JAILHOUSE_MEM_WRITE'
324
325
326 class IOAPIC:
327     def __init__(self, id, address, gsi_base, iommu=0, bdf=0):
328         self.id = id
329         self.address = address
330         self.gsi_base = gsi_base
331         self.iommu = iommu
332         self.bdf = bdf
333
334     def __str__(self):
335         return 'IOAPIC %d, GSI base %d' % (self.id, self.gsi_base)
336
337     def irqchip_id(self):
338         # encode the IOMMU number into the irqchip ID
339         return (self.iommu << 16) | self.bdf
340
341
342 class IOMemRegionTree:
343     def __init__(self, region, level):
344         self.region = region
345         self.level = level
346         self.parent = None
347         self.children = []
348
349     def __str__(self):
350         s = ''
351         if (self.region):
352             s = (' ' * (self.level - 1)) + str(self.region)
353             if self.parent and self.parent.region:
354                 s += ' --> ' + self.parent.region.typestr
355             s += '\n'
356         for c in self.children:
357             s += str(c)
358         return s
359
360     def regions_split_by_kernel(self):
361         kernel = [x for x in self.children if
362                   x.region.typestr.startswith('Kernel ')]
363
364         if (len(kernel) == 0):
365             return [self.region]
366
367         r = self.region
368         s = r.typestr
369
370         kernel_start = kernel[0].region.start
371         kernel_stop = kernel[len(kernel) - 1].region.stop
372
373         # align this for 16M, but only if we have enough space
374         kernel_stop = (kernel_stop & ~0xFFFFFF) + 0xFFFFFF
375         if (kernel_stop > r.stop):
376             kernel_stop = r.stop
377
378         before_kernel = None
379         after_kernel = None
380
381         # before Kernel if any
382         if (r.start < kernel_start):
383             before_kernel = MemRegion(r.start, kernel_start - 1, s)
384
385         kernel_region = MemRegion(kernel_start, kernel_stop, "Kernel")
386
387         # after Kernel if any
388         if (r.stop > kernel_stop):
389             after_kernel = MemRegion(kernel_stop + 1, r.stop, s)
390
391         return [before_kernel, kernel_region, after_kernel]
392
393     @staticmethod
394     def parse_iomem_line(line):
395         a = line.split(':', 1)
396         level = int(a[0].count(' ') / 2) + 1
397         region = a[0].split('-', 1)
398         a[1] = a[1].strip()
399         return level, MemRegion(int(region[0], 16), int(region[1], 16), a[1])
400
401     @staticmethod
402     def parse_iomem_file():
403         root = IOMemRegionTree(None, 0)
404         f = input_open('/proc/iomem')
405         lastlevel = 0
406         lastnode = root
407         for line in f:
408             (level, r) = IOMemRegionTree.parse_iomem_line(line)
409             t = IOMemRegionTree(r, level)
410             if (t.level > lastlevel):
411                 t.parent = lastnode
412             if (t.level == lastlevel):
413                 t.parent = lastnode.parent
414             if (t.level < lastlevel):
415                 p = lastnode.parent
416                 while(t.level < p.level):
417                     p = p.parent
418                 t.parent = p.parent
419
420             t.parent.children.append(t)
421             lastnode = t
422             lastlevel = t.level
423         f.close()
424
425         return root
426
427     # find HPET regions in tree
428     @staticmethod
429     def find_hpet_regions(tree):
430         regions = []
431
432         for tree in tree.children:
433             r = tree.region
434             s = r.typestr
435
436             if (s.find('HPET') >= 0):
437                 regions.append(r)
438
439             # if the tree continues recurse further down ...
440             if (len(tree.children) > 0):
441                 regions.extend(IOMemRegionTree.find_hpet_regions(tree))
442
443         return regions
444
445     # recurse down the tree
446     @staticmethod
447     def parse_iomem_tree(tree):
448         regions = []
449
450         for tree in tree.children:
451             r = tree.region
452             s = r.typestr
453
454             # System RAM on the first level will be added completely,
455             # if they don't contain the kernel itself, if they do,
456             # we split them
457             if (tree.level == 1 and s == 'System RAM'):
458                 regions.extend(tree.regions_split_by_kernel())
459                 continue
460
461             # blacklisted on all levels
462             if (
463                 (s.find('PCI MMCONFIG') >= 0) or
464                 (s.find('APIC') >= 0) or  # covers both APIC and IOAPIC
465                 (s.find('dmar') >= 0)
466             ):
467                 continue
468
469             # generally blacklisted, unless we find an HPET behind it
470             if (s == 'reserved'):
471                 regions.extend(IOMemRegionTree.find_hpet_regions(tree))
472                 continue
473
474             # if the tree continues recurse further down ...
475             if (len(tree.children) > 0):
476                 regions.extend(IOMemRegionTree.parse_iomem_tree(tree))
477                 continue
478
479             # add all remaining leaves
480             regions.append(r)
481
482         return regions
483
484
485 def parse_iomem(pcidevices):
486     regions = IOMemRegionTree.parse_iomem_tree(
487         IOMemRegionTree.parse_iomem_file())
488
489     # filter the list for MSI-X pages
490     ret = []
491     for r in regions:
492         for d in pcidevices:
493             if d.msix_address >= r.start and d.msix_address <= r.stop:
494                 if d.msix_address > r.start:
495                     head_r = MemRegion(r.start, d.msix_address - 1,
496                                        r.typestr, r.comments)
497                     ret.append(head_r)
498                 if d.msix_address + d.msix_region_size < r.stop:
499                     tail_r = MemRegion(d.msix_address + d.msix_region_size,
500                                        r.stop, r.typestr, r.comments)
501                     ret.append(tail_r)
502                 r = None
503                 break
504         if r:
505             ret.append(r)
506
507     # newer Linux kernels will report the first page as reserved
508     # it is needed for CPU init so include it anyways
509     if (ret[0].typestr == 'System RAM' and ret[0].start == 0x1000):
510         ret[0].start = 0
511
512     return ret
513
514
515 def parse_pcidevices():
516     devices = []
517     caps = []
518     basedir = '/sys/bus/pci/devices'
519     list = input_listdir(basedir, ['*/config'])
520     for dir in list:
521         d = PCIDevice.parse_pcidevice_sysfsdir(basedir, dir)
522         if d is not None:
523             if len(d.caps) > 0:
524                 duplicate = False
525                 # look for duplicate capability patterns
526                 for d2 in devices:
527                     if d2.caps == d.caps:
528                         # reused existing capability list, but record all users
529                         d2.caps[0].comments.append(str(d))
530                         d.caps_start = d2.caps_start
531                         duplicate = True
532                         break
533                 if not duplicate:
534                     d.caps[0].comments.append(str(d))
535                     d.caps_start = len(caps)
536                     caps.extend(d.caps)
537             devices.append(d)
538     return (devices, caps)
539
540
541 def parse_kernel_cmdline():
542     line = input_readline('/proc/cmdline')
543     m = re.match(r'.*memmap=([0-9a-fA-FxX]+)([KMG]?)\$'
544                  '([0-9a-fA-FxX]+)([KMG]?).*',
545                  line)
546     if m is not None:
547         size = kmg_multiply(int(m.group(1), 0), m.group(2))
548         start = kmg_multiply(int(m.group(3), 0), m.group(4))
549         return [start, size]
550     return None
551
552
553 def alloc_mem(regions, size):
554     mem = [0x3b000000, size]
555     for r in regions:
556         if (
557             r.typestr == 'System RAM' and
558             r.start <= mem[0] and
559             r.stop + 1 >= mem[0] + mem[1]
560         ):
561             if r.start < mem[0]:
562                 head_r = MemRegion(r.start, mem[0] - 1, r.typestr, r.comments)
563                 regions.insert(regions.index(r), head_r)
564             if r.stop + 1 > mem[0] + mem[1]:
565                 tail_r = MemRegion(mem[0] + mem[1], r.stop, r.typestr,
566                                    r.comments)
567                 regions.insert(regions.index(r), tail_r)
568             regions.remove(r)
569             return mem
570     for r in reversed(regions):
571         if (r.typestr == 'System RAM' and r.size() >= mem[1]):
572             mem[0] = r.start
573             r.start += mem[1]
574             return mem
575     raise RuntimeError('failed to allocate memory')
576
577
578 def count_cpus():
579     list = input_listdir('/sys/devices/system/cpu', ['cpu*/uevent'])
580     count = 0
581     for f in list:
582         if re.match(r'cpu[0-9]+', f):
583             count += 1
584     return count
585
586
587 def parse_madt():
588     f = input_open('/sys/firmware/acpi/tables/APIC', 'rb')
589     signature = f.read(4)
590     if signature != b'APIC':
591         raise RuntimeError('MADT: incorrect input file format %s' % signature)
592     (length,) = struct.unpack('<I', f.read(4))
593     f.seek(44)
594     length -= 44
595     ioapics = []
596
597     while length > 0:
598         offset = 0
599         (struct_type, struct_len) = struct.unpack('<BB', f.read(2))
600         offset += 2
601         length -= struct_len
602
603         if struct_type == 1:
604             (id, address, gsi_base) = struct.unpack('<BxII', f.read(10))
605             offset += 10
606             ioapics.append(IOAPIC(id, address, gsi_base))
607
608         f.seek(struct_len - offset, os.SEEK_CUR)
609
610     f.close()
611     return ioapics
612
613
614 def parse_dmar_devscope(f):
615     (scope_type, scope_len, id, bus, dev, fn) = \
616         struct.unpack('<BBxxBBBB', f.read(8))
617     if scope_len != 8:
618         raise RuntimeError('Unsupported DMAR Device Scope Structure')
619     return (scope_type, scope_len, id, bus, dev, fn)
620
621
622 # parsing of DMAR ACPI Table
623 # see Intel VT-d Spec chapter 8
624 def parse_dmar(pcidevices, ioapics):
625     f = input_open('/sys/firmware/acpi/tables/DMAR', 'rb')
626     signature = f.read(4)
627     if signature != b'DMAR':
628         raise RuntimeError('DMAR: incorrect input file format %s' % signature)
629     (length,) = struct.unpack('<I', f.read(4))
630     f.seek(48)
631     length -= 48
632     units = []
633     regions = []
634
635     while length > 0:
636         offset = 0
637         (struct_type, struct_len) = struct.unpack('<HH', f.read(4))
638         offset += 4
639         length -= struct_len
640
641         # DMA Remapping Hardware Unit Definition
642         if struct_type == 0:
643             (flags, segment, base) = struct.unpack('<BxHQ', f.read(12))
644             if segment != 0:
645                 raise RuntimeError('We do not support multiple PCI segments')
646             if len(units) >= 8:
647                 raise RuntimeError('Too many DMAR units. '
648                                    'Raise JAILHOUSE_MAX_IOMMU_UNITS.')
649             units.append(base)
650             if flags & 1:
651                 for d in pcidevices:
652                     if d.iommu is None:
653                         d.iommu = len(units) - 1
654             offset += 16 - offset
655             while offset < struct_len:
656                 (scope_type, scope_len, id, bus, dev, fn) =\
657                     parse_dmar_devscope(f)
658                 # PCI Endpoint Device
659                 if scope_type == 1:
660                     assert not (flags & 1)
661                     for d in pcidevices:
662                         if d.bus == bus and d.dev == dev and d.fn == fn:
663                             d.iommu = len(units) - 1
664                             break
665                 # PCI Sub-hierarchy
666                 elif scope_type == 2:
667                     assert not (flags & 1)
668                     for d in pcidevices:
669                         if d.bus == bus and d.dev == dev and d.fn == fn:
670                             (secondbus, subordinate) = \
671                                 PCIPCIBridge.get_2nd_busses(d)
672                             for d2 in pcidevices:
673                                 if (
674                                     d2.bus >= secondbus and
675                                     d2.bus <= subordinate
676                                 ):
677                                     d2.iommu = len(units) - 1
678                             break
679                 # IOAPIC
680                 elif scope_type == 3:
681                     ioapic = next(chip for chip in ioapics if chip.id == id)
682                     bdf = (bus << 8) | (dev << 3) | fn
683                     for chip in ioapics:
684                         if chip.bdf == bdf:
685                             raise RuntimeError('IOAPICs with identical BDF')
686                     ioapic.bdf = bdf
687                     ioapic.dmar_unit = len(units) - 1
688                 offset += scope_len
689
690         # Reserved Memory Region Reporting Structure
691         if struct_type == 1:
692             f.seek(8 - offset, os.SEEK_CUR)
693             offset += 8 - offset
694             (base, limit) = struct.unpack('<QQ', f.read(16))
695             offset += 16
696
697             comments = []
698             while offset < struct_len:
699                 (scope_type, scope_len, id, bus, dev, fn) =\
700                     parse_dmar_devscope(f)
701                 if scope_type == 1:
702                     comments.append('PCI device: %02x:%02x.%x' %
703                                     (bus, dev, fn))
704                 else:
705                     comments.append('DMAR parser could not decode device path')
706                 offset += scope_len
707
708             reg = MemRegion(base, limit, 'ACPI DMAR RMRR', comments)
709             regions.append(reg)
710
711         f.seek(struct_len - offset, os.SEEK_CUR)
712
713     f.close()
714
715     for d in pcidevices:
716         if d.iommu is None:
717             raise RuntimeError(
718                 'PCI device %02x:%02x.%x outside the scope of an '
719                 'IOMMU' % (d.bus, d.dev, d.fn))
720
721     return units, regions
722
723
724 def parse_ivrs(pcidevices, ioapics):
725     def format_bdf(bdf):
726         bus, dev, fun = (bdf >> 8) & 0xff, (bdf >> 3) & 0x1f, bdf & 0x7
727         return '%02x:%02x.%x' % (bus, dev, fun)
728
729     f = input_open('/sys/firmware/acpi/tables/IVRS', 'rb')
730     signature = f.read(4)
731     if signature != b'IVRS':
732         raise RuntimeError('IVRS: incorrect input file format %s' % signature)
733
734     (length, revision) = struct.unpack('<IB', f.read(5))
735     if revision > 2:
736         raise RuntimeError('IVRS: unsupported Revision %02x' % revision)
737
738     f.seek(48, os.SEEK_SET)
739     length -= 48
740
741     units = []
742     regions = []
743     # BDF of devices that are permitted outside IOMMU: root complex
744     iommu_skiplist = set([0x0])
745     while length > 0:
746         (block_type, block_length) = struct.unpack('<BxH', f.read(4))
747         if block_type in [0x10, 0x11]:
748             # IVHD block
749             (iommu_id, base_addr, pci_seg) = \
750                 struct.unpack('<HxxQH', f.read(14))
751             length -= block_length
752             block_length -= 18
753
754             # IOMMU EFR image and reserved area
755             skip_bytes = 6 if block_type == 0x10 else 22
756             f.seek(skip_bytes, os.SEEK_CUR)
757             block_length -= skip_bytes
758
759             if pci_seg != 0:
760                 raise RuntimeError('We do not support multiple PCI segments')
761
762             if len(units) > 8:
763                 raise RuntimeError('Too many IOMMU units. '
764                                    'Raise JAILHOUSE_MAX_IOMMU_UNITS.')
765
766             # We shouldn't map IOMMU to the cells
767             for i, d in enumerate(pcidevices):
768                 if d.bdf() == iommu_id:
769                     del pcidevices[i]
770
771             units.append(base_addr)
772
773             bdf_start_range = None
774             while block_length > 0:
775                 (entry_type, device_id, dte_setting) = struct.unpack(
776                     '<BHB', f.read(4))
777                 block_length -= 4
778
779                 if entry_type == 0x01:
780                     # All
781                     for d in pcidevices:
782                         d.iommu = len(units) - 1
783                 elif entry_type == 0x02:
784                     # Select
785                     for d in pcidevices:
786                         if d.bdf() == device_id:
787                             d.iommu = len(units) - 1
788                 elif entry_type == 0x03:
789                     # Start of range
790                     bdf_start_range = device_id
791                 elif entry_type == 0x04:
792                     # End of range
793                     if bdf_start_range is None:
794                         continue
795                     for d in pcidevices:
796                         if d.bdf() >= bdf_start_range and d.bdf() <= device_id:
797                             d.iommu = len(units) - 1
798                     bdf_start_range = None
799                 elif entry_type == 0x42:
800                     # Alias select
801                     (device_id_b,) = struct.unpack('<xHx', f.read(4))
802                     block_length -= 4
803                     for d in pcidevices:
804                         if d.bdf() == device_id_b:
805                             d.iommu = len(units) - 1
806                 elif entry_type == 0x43:
807                     # Alias start of range
808                     (device_id_b,) = struct.unpack('<xHx', f.read(4))
809                     block_length -= 4
810                     bdf_start_range = device_id_b
811                 elif entry_type == 0x48:
812                     # Special device
813                     (handle, device_id_b, variety) = struct.unpack(
814                         '<BHB', f.read(4))
815                     block_length -= 4
816                     if variety == 0x01:  # IOAPIC
817                         for chip in ioapics:
818                             if chip.id == handle:
819                                 chip.bdf = device_id
820                                 chip.iommu = len(units) - 1
821                 else:
822                     # Reserved or ignored entries
823                     if entry_type >= 0x40:
824                         f.seek(4, os.SEEK_CUR)
825                         block_length -= 4
826
827         elif type in [0x20, 0x21, 0x22]:
828             # IVMD block
829             (block_type, block_flags, block_length,
830              device_id, aux_data, mem_addr, mem_len) = struct.unpack(
831                  '<BBHHHxxxxxxxxQQ')
832             length -= block_length
833
834             if int(block_flags):
835                 bdf_str = format_bdf(device_id)
836                 print(
837                     'WARNING: Jailhouse doesn\'t support configurable '
838                     '(eg. read-only) device memory. Device %s may not '
839                     'work properly, especially in non-root cell.' % bdf_str)
840
841             if block_type == 0x20:
842                 # All devices
843                 comment = None
844             elif block_type == 0x21:
845                 # Selected device
846                 comment = 'PCI Device: %s' % format_bdf(device_id)
847             elif block_type == 0x22:
848                 # Device range
849                 comment = 'PCI Device: %s - %s' % (
850                     format_bdf(device_id), format_bdf(aux_data))
851
852             if comment:
853                 print('WARNING: Jailhouse doesn\'t support per-device memory '
854                       'regions. The memory at 0x%x will be mapped accessible '
855                       'to all devices.' % mem_addr)
856
857             regions.append(MemRegion(mem_addr, mem_len, 'ACPI IVRS', comment))
858         elif type == 0x40:
859             raise RuntimeError(
860                 'You board uses IVRS Rev. 2 feature Jailhouse doesn\'t '
861                 'support yet. Please report this to '
862                 'jailhouse-dev@googlegroups.com.')
863         else:
864             print(
865                 'WARNING: Skipping unknown IVRS '
866                 'block type 0x%02x' % block_type)
867
868         for d in pcidevices:
869             if d.bdf() not in iommu_skiplist and d.iommu is None:
870                 raise RuntimeError(
871                     'PCI device %02x:%02x.%x outside the scope of an '
872                     'IOMMU' % (d.bus, d.dev, d.fn))
873
874         f.close()
875         return units, regions
876
877
878 def parse_ioports():
879     pm_timer_base = None
880     f = input_open('/proc/ioports')
881     for line in f:
882         if line.endswith('ACPI PM_TMR\n'):
883             pm_timer_base = int(line.split('-')[0], 16)
884             break
885     f.close()
886     return pm_timer_base
887
888
889 class MMConfig:
890     def __init__(self, base, end_bus):
891         self.base = base
892         self.end_bus = end_bus
893
894     @staticmethod
895     def parse():
896         f = input_open('/sys/firmware/acpi/tables/MCFG', 'rb')
897         signature = f.read(4)
898         if signature != b'MCFG':
899             raise RuntimeError('MCFG: incorrect input file format %s' %
900                                signature)
901         (length,) = struct.unpack('<I', f.read(4))
902         if length > 60:
903             raise RuntimeError('Multiple MMCONFIG regions found! '
904                                'This is not supported')
905         f.seek(44)
906         (base, segment, start_bus, end_bus) = \
907             struct.unpack('<QHBB', f.read(12))
908         if segment != 0 or start_bus != 0:
909             raise RuntimeError('Invalid MCFG structure found')
910         return MMConfig(base, end_bus)
911
912
913 def get_cpu_vendor():
914     global cpuvendor
915     if cpuvendor is not None:
916         return cpuvendor
917     with input_open('/proc/cpuinfo', 'r') as f:
918         for line in f:
919             if not line.strip():
920                 continue
921             key, value = line.split(':')
922             if key.strip() == 'vendor_id':
923                 cpuvendor = value.strip()
924                 return cpuvendor
925
926
927 if options.generate_collector:
928     f = open(options.file, 'w')
929     filelist = ' '.join(inputs['files'])
930     filelist_opt = ' '.join(inputs['files_opt'])
931     filelist_intel = ' '.join(inputs['files_intel'])
932     filelist_amd = ' '.join(inputs['files_amd'])
933
934     tmpl = Template(filename=os.path.join(options.template_dir,
935                                           'jailhouse-config-collect.tmpl'))
936     f.write(tmpl.render(filelist=filelist, filelist_opt=filelist_opt,
937             filelist_intel=filelist_intel, filelist_amd=filelist_amd))
938     f.close()
939     sys.exit(0)
940
941 if ((options.root is '/') and (os.geteuid() is not 0)):
942     print('ERROR: You have to be root to work on "/"!', file=sys.stderr)
943     sys.exit(1)
944
945 jh_enabled = input_readline('/sys/devices/jailhouse/enabled', True).rstrip()
946 if jh_enabled == '1':
947     print('ERROR: Jailhouse was enabled when collecting input files! '
948           'Disable jailhouse and try again.',
949           file=sys.stderr)
950     sys.exit(1)
951
952 (pcidevices, pcicaps) = parse_pcidevices()
953
954 product = [input_readline('/sys/class/dmi/id/sys_vendor',
955                           True).rstrip(),
956            input_readline('/sys/class/dmi/id/product_name',
957                           True).rstrip()
958            ]
959
960 inmatemem = kmg_multiply_str(options.mem_inmates)
961 hvmem = [0, kmg_multiply_str(options.mem_hv)]
962
963 regions = parse_iomem(pcidevices)
964 ourmem = parse_kernel_cmdline()
965 total = hvmem[1] + inmatemem
966
967 mmconfig = MMConfig.parse()
968
969 ioapics = parse_madt()
970
971 vendor = get_cpu_vendor()
972 if vendor == 'GenuineIntel':
973     (iommu_units, extra_memregs) = parse_dmar(pcidevices, ioapics)
974 else:
975     (iommu_units, extra_memregs) = parse_ivrs(pcidevices, ioapics)
976 regions += extra_memregs
977
978 # kernel does not have memmap region, pick one
979 if ourmem is None:
980     ourmem = alloc_mem(regions, total)
981 elif (total > ourmem[1]):
982     raise RuntimeError('Your memmap reservation is too small you need >="' +
983                        hex(total) + '"')
984
985 hvmem[0] = ourmem[0]
986
987 inmatereg = MemRegion(ourmem[0] + hvmem[1],
988                       ourmem[0] + hvmem[1] + inmatemem - 1,
989                       'JAILHOUSE Inmate Memory')
990 regions.append(inmatereg)
991
992 cpucount = count_cpus()
993
994 pm_timer_base = parse_ioports()
995
996
997 f = open(options.file, 'w')
998 tmpl = Template(filename=os.path.join(options.template_dir,
999                                       'root-cell-config.c.tmpl'))
1000 kwargs = {
1001     'regions': regions,
1002     'ourmem': ourmem,
1003     'argstr': ' '.join(sys.argv),
1004     'hvmem': hvmem,
1005     'product': product,
1006     'pcidevices': pcidevices,
1007     'pcicaps': pcicaps,
1008     'cpucount': cpucount,
1009     'irqchips': ioapics,
1010     'pm_timer_base': pm_timer_base,
1011     'mmconfig': mmconfig,
1012     'iommu_units': iommu_units
1013 }
1014
1015 f.write(tmpl.render(**kwargs))
1016
1017 f.close()