lrdp-v2: Secure watchdog call stack parsing correction of PC register

	We have to use alternate PC value if PC is bad.
	We will have 2 alternate PC values(ALT_PC_1 and ALT+PC_2),
	we should pick nearest value to the 32bit PC.
	If PC is 64bit value the take the PC only

Change-Id: Ibf74bea1d549fd5d1e1549da5d3ae898c9606d43

linux-ramdump-parser-v2/debug_image_v2.py

@@ -160,6 +160,7 @@ class DebugImage_v2():
         reg_info = sv2.prepare_dict()
         if reg_info is not None:
             sv2.dump_core_pc(ram_dump)
+            sv2.dump_all_regs(ram_dump)
         return
 
     def parse_cpu_ctx(self, version, start, end, client_id, ram_dump):

linux-ramdump-parser-v2/scandump_reader.py

@@ -14,6 +14,105 @@ import re
 import os
 from print_out import print_out_str
 
+scandump_registers_32 = [
+    ('r0', 'r0', False),
+    ('r1', 'r1', False),
+    ('r2', 'r2', False),
+    ('r3', 'r3', False),
+    ('r4', 'r4', False),
+    ('r5', 'r5', False),
+    ('r6', 'r6', False),
+    ('r7', 'r7', False),
+    ('r8', 'r8', False),
+    ('r9', 'r9', False),
+    ('r10', 'r10', False),
+    ('r11', 'r11', False),
+    ('r12', 'r12', False),
+    ('r13_usr', 'r13_usr', False),
+    ('r14_usr', 'r14_usr', False),
+    ('r13_hyp', 'r13_hyp', False),
+    ('r14_irq', 'r14_irq', True),
+    ('r13_irq', 'r13_irq', False),
+    ('r14_svc', 'r14_svc', True),
+    ('r13_svc', 'r13_svc', False),
+    ('r14_abt', 'r14_abt', True),
+    ('r13_abt', 'r13_abt', False),
+    ('r14_und', 'r14_und', True),
+    ('r13_und', 'r13_und', False),
+    ('r8_fiq', 'r8_fiq', False),
+    ('r9_fiq', 'r9_fiq', False),
+    ('r10_fiq', 'r10_fiq', False),
+    ('r11_fiq', 'r11_fiq', False),
+    ('r12_fiq', 'r12_fiq', False),
+    ('r13_fiq', 'r13_fiq', False),
+    ('r14_fiq', 'r14_fiq', True),
+    ('pc', 'pc', True),
+    ('cpsr', 'cpsr', False),
+    ('r13_mon', 'r13_mon', False),
+    ('r14_mon', 'r14_mon', True),
+    ('r14_hyp', 'elr_hyp', True),
+    ('_reserved', '_reserved', False),
+    ('__reserved1', '__reserved1', False),
+    ('__reserved2', '__reserved2', False),
+    ('__reserved3', '__reserved3', False),
+    ('__reserved4', '__reserved4', False),
+]
+
+scandump_registers_64 = [
+    ('x0', 'x0', False),
+    ('x1', 'x1', False),
+    ('x2', 'x2', False),
+    ('x3', 'x3', False),
+    ('x4', 'x4', False),
+    ('x5', 'x5', False),
+    ('x6', 'x6', False),
+    ('x7', 'x7', False),
+    ('x8', 'x8', False),
+    ('x9', 'x9', False),
+    ('x10', 'x10', False),
+    ('x11', 'x11', False),
+    ('x12', 'x12', False),
+    ('x13', 'x13', False),
+    ('x14', 'x14', False),
+    ('x15', 'x15', False),
+    ('x16', 'x16', False),
+    ('x17', 'x17', False),
+    ('x18', 'x18', False),
+    ('x19', 'x19', False),
+    ('x20', 'x20', False),
+    ('x21', 'x21', False),
+    ('x22', 'x22', False),
+    ('x23', 'x23', False),
+    ('x24', 'x24', False),
+    ('x25', 'x25', False),
+    ('x26', 'x26', False),
+    ('x27', 'x27', False),
+    ('x28', 'x28', False),
+    ('x29', 'x29', False),
+    ('x30', 'x30', True),
+    ('pc', 'pc', True),
+    ('currentEL', None, False),
+    ('sp_el3', 'sp_el3', False),
+    ('elr_el3', 'elr_el3', True),
+    ('spsr_el3', 'spsr_el3', False),
+    ('sp_el2', 'sp_el2', False),
+    ('elr_el2', 'elr_el2', True),
+    ('spsr_el2', 'spsr_el2', False),
+    ('sp_el1', 'sp_el1', False),
+    ('elr_el1', 'elr_el1', True),
+    ('spsr_el1', 'spsr_el1', False),
+    ('sp_el0', 'sp_el0', False),
+    ('cpu_state_0', 'cpu_state_0', False),
+    ('cpu_state_1', 'cpu_state_1', False),
+    ('cpu_state_3', 'cpu_state_3', False),
+    ('cpu_state_4', 'cpu_state_4', False),
+    ('cpu_state_5', 'cpu_state_5', False),
+    ('__reserved1', '__reserved1', False),
+    ('__reserved2', '__reserved2', False),
+    ('__reserved3', '__reserved3', False),
+    ('__reserved4', '__reserved4', False),
+]
+
 
 class Scandump_v2():
 
@@ -23,6 +122,7 @@ class Scandump_v2():
         self.version = version
         self.ramdump = ramdump
         self.init_missing_regs()
+        self.max_32 = "0xFFFFFFFF"
 
     def init_missing_regs(self):
         self.regs['currentEL'] = 0
@@ -35,10 +135,21 @@ class Scandump_v2():
         self.regs['cpu_state_4'] = 0
         self.regs['cpu_state_5'] = 0
 
+    def alt_pc_selection(self, pc_val):
+        max_32_int = int(self.max_32, 16)
+        pc_val_int = int(pc_val, 16)
+        if pc_val_int <= max_32_int:
+            return True
+        return False
+
     def prepare_dict(self):
         input_file = "scandump"
         input_file_name = "{0}_core_{1}.cmm".format(input_file, (self.core))
         output = os.path.join(self.ramdump.outdir, input_file_name)
+        alt_pc_1 = None
+        alt_pc_2 = None
+        pc_val = ""
+
         if os.path.exists(output):
             fd = open(output, "r")
             for line in fd:
@@ -54,13 +165,71 @@ class Scandump_v2():
                         regVal = matchObj.group(2)
                         if regVal == "0x":
                             regVal = "0x0000000000000000"
-                        self.regs[matchObj.group(1).lower()] = int(regVal, 16)
+                        pc_val = regVal
+
+                    matchObj_altpc = re.match('^REGISTER.SET (ALT_PC_1)\s(0x[0-9a-f]{0,})', line, re.M | re.I)
+                    if matchObj_altpc:
+                        alt_pc_1 = matchObj_altpc.group(2)
+                        if alt_pc_1 == "0x":
+                            alt_pc_1 = "0x0000000000000000"
+                    matchObj_altpc = re.match('^REGISTER.SET (ALT_PC_2)\s(0x[0-9a-f]{0,})', line, re.M | re.I)
+                    if matchObj_altpc:
+                        alt_pc_2 = matchObj_altpc.group(2)
+                        if alt_pc_2 == "0x":
+                            alt_pc_2 = "0x0000000000000000"
+
+            result_32 = self.alt_pc_selection(pc_val)
+            if result_32:
+                if alt_pc_1 and alt_pc_2:
+                    diff_alt_pc1 = int(alt_pc_1, 16) - int(pc_val, 16)
+                    diff_alt_pc2 = int(alt_pc_2, 16) - int(pc_val, 16)
+
+                    if diff_alt_pc1 > diff_alt_pc2:
+                        self.regs['pc'] = int(alt_pc_2, 16)
                     else:
-                        continue
+                        self.regs['pc'] = int(alt_pc_1, 16)
+
+                elif alt_pc_1 and not alt_pc_2:
+                    self.regs['pc'] = int(alt_pc_1, 16)
+                elif alt_pc_2 and not alt_pc_1:
+                    self.regs['pc'] = int(alt_pc_2, 16)
+                else:
+                    self.regs['pc'] = int(pc_val, 16)
+            else:
+                self.regs['pc'] = int(pc_val, 16)
             return self.regs
         else:
             return None
 
+    def print_regs(self, ramdump):
+        if ramdump.arm64:
+            register_names = scandump_registers_64
+        else:
+            register_names = scandump_registers_32
+        for reg_name, t32_name, print_pc in register_names:
+            if re.match('(.*)reserved(.*)', reg_name):
+                continue
+            if print_pc:
+                a = ramdump.unwind_lookup(self.regs[reg_name])
+                if a is not None:
+                    symname, offset = ramdump.unwind_lookup(
+                        self.regs[reg_name])
+                    pc_string = '[{0}+0x{1:x}]'.format(symname, offset)
+                else:
+                    pc_string = None
+            else:
+                pc_string = None
+            if pc_string is not None:
+                print_out_str('   {0:8} = 0x{1:016x} {2}'.format(
+                              reg_name, self.regs[reg_name], pc_string))
+            else:
+                print_out_str('   {0:8} = 0x{1:016x}'.format(
+                              reg_name, self.regs[reg_name]))
+
+    def dump_all_regs(self, ram_dump):
+        print_out_str('core{0} regs:'.format(self.core))
+        self.print_regs(ram_dump)
+
     def dump_core_pc(self, ram_dump):
         pc = self.regs['pc']
         if ram_dump.arm64:
@@ -93,4 +262,3 @@ class Scandump_v2():
         print_out_str('')
         ram_dump.unwind.unwind_backtrace(bt, fp, pc, lr, '')
         print_out_str('')
-