1724dc336SVasily Gorbik // SPDX-License-Identifier: GPL-2.0 2724dc336SVasily Gorbik #include <linux/kernel.h> 3724dc336SVasily Gorbik #include <linux/string.h> 49a78c70aSVasily Gorbik #include <linux/ctype.h> 5724dc336SVasily Gorbik #include <asm/lowcore.h> 63ca8b855SVasily Gorbik #include <asm/setup.h> 7724dc336SVasily Gorbik #include <asm/sclp.h> 89a78c70aSVasily Gorbik #include <stdarg.h> 9724dc336SVasily Gorbik #include "boot.h" 10724dc336SVasily Gorbik 11724dc336SVasily Gorbik const char hex_asc[] = "0123456789abcdef"; 12724dc336SVasily Gorbik 139a78c70aSVasily Gorbik static char *as_hex(char *dst, unsigned long val, int pad) 14724dc336SVasily Gorbik { 159a78c70aSVasily Gorbik char *p, *end = p = dst + max(pad, (int)__fls(val | 1) / 4 + 1); 169a78c70aSVasily Gorbik 179a78c70aSVasily Gorbik for (*p-- = 0; p >= dst; val >>= 4) 189a78c70aSVasily Gorbik *p-- = hex_asc[val & 0x0f]; 199a78c70aSVasily Gorbik return end; 20724dc336SVasily Gorbik } 21724dc336SVasily Gorbik 22*24621896SVasily Gorbik static char *symstart(char *p) 23*24621896SVasily Gorbik { 24*24621896SVasily Gorbik while (*p) 25*24621896SVasily Gorbik p--; 26*24621896SVasily Gorbik return p + 1; 27*24621896SVasily Gorbik } 28*24621896SVasily Gorbik 29*24621896SVasily Gorbik extern char _decompressor_syms_start[], _decompressor_syms_end[]; 30*24621896SVasily Gorbik static noinline char *findsym(unsigned long ip, unsigned short *off, unsigned short *len) 31*24621896SVasily Gorbik { 32*24621896SVasily Gorbik /* symbol entries are in a form "10000 c4 startup\0" */ 33*24621896SVasily Gorbik char *a = _decompressor_syms_start; 34*24621896SVasily Gorbik char *b = _decompressor_syms_end; 35*24621896SVasily Gorbik unsigned long start; 36*24621896SVasily Gorbik unsigned long size; 37*24621896SVasily Gorbik char *pivot; 38*24621896SVasily Gorbik char *endp; 39*24621896SVasily Gorbik 40*24621896SVasily Gorbik while (a < b) { 41*24621896SVasily Gorbik pivot = symstart(a + (b - a) / 2); 42*24621896SVasily Gorbik start = simple_strtoull(pivot, &endp, 16); 43*24621896SVasily Gorbik size = simple_strtoull(endp + 1, &endp, 16); 44*24621896SVasily Gorbik if (ip < start) { 45*24621896SVasily Gorbik b = pivot; 46*24621896SVasily Gorbik continue; 47*24621896SVasily Gorbik } 48*24621896SVasily Gorbik if (ip > start + size) { 49*24621896SVasily Gorbik a = pivot + strlen(pivot) + 1; 50*24621896SVasily Gorbik continue; 51*24621896SVasily Gorbik } 52*24621896SVasily Gorbik *off = ip - start; 53*24621896SVasily Gorbik *len = size; 54*24621896SVasily Gorbik return endp + 1; 55*24621896SVasily Gorbik } 56*24621896SVasily Gorbik return NULL; 57*24621896SVasily Gorbik } 58*24621896SVasily Gorbik 59*24621896SVasily Gorbik static noinline char *strsym(void *ip) 60*24621896SVasily Gorbik { 61*24621896SVasily Gorbik static char buf[64]; 62*24621896SVasily Gorbik unsigned short off; 63*24621896SVasily Gorbik unsigned short len; 64*24621896SVasily Gorbik char *p; 65*24621896SVasily Gorbik 66*24621896SVasily Gorbik p = findsym((unsigned long)ip, &off, &len); 67*24621896SVasily Gorbik if (p) { 68*24621896SVasily Gorbik strncpy(buf, p, sizeof(buf)); 69*24621896SVasily Gorbik /* reserve 15 bytes for offset/len in symbol+0x1234/0x1234 */ 70*24621896SVasily Gorbik p = buf + strnlen(buf, sizeof(buf) - 15); 71*24621896SVasily Gorbik strcpy(p, "+0x"); 72*24621896SVasily Gorbik p = as_hex(p + 3, off, 0); 73*24621896SVasily Gorbik strcpy(p, "/0x"); 74*24621896SVasily Gorbik as_hex(p + 3, len, 0); 75*24621896SVasily Gorbik } else { 76*24621896SVasily Gorbik as_hex(buf, (unsigned long)ip, 16); 77*24621896SVasily Gorbik } 78*24621896SVasily Gorbik return buf; 79*24621896SVasily Gorbik } 80*24621896SVasily Gorbik 819a78c70aSVasily Gorbik void decompressor_printk(const char *fmt, ...) 82724dc336SVasily Gorbik { 839a78c70aSVasily Gorbik char buf[1024] = { 0 }; 849a78c70aSVasily Gorbik char *end = buf + sizeof(buf) - 1; /* make sure buf is 0 terminated */ 859a78c70aSVasily Gorbik unsigned long pad; 869a78c70aSVasily Gorbik char *p = buf; 879a78c70aSVasily Gorbik va_list args; 889a78c70aSVasily Gorbik 899a78c70aSVasily Gorbik va_start(args, fmt); 909a78c70aSVasily Gorbik for (; p < end && *fmt; fmt++) { 919a78c70aSVasily Gorbik if (*fmt != '%') { 929a78c70aSVasily Gorbik *p++ = *fmt; 939a78c70aSVasily Gorbik continue; 949a78c70aSVasily Gorbik } 959a78c70aSVasily Gorbik pad = isdigit(*++fmt) ? simple_strtol(fmt, (char **)&fmt, 10) : 0; 969a78c70aSVasily Gorbik switch (*fmt) { 979a78c70aSVasily Gorbik case 's': 989a78c70aSVasily Gorbik p = buf + strlcat(buf, va_arg(args, char *), sizeof(buf)); 999a78c70aSVasily Gorbik break; 100*24621896SVasily Gorbik case 'p': 101*24621896SVasily Gorbik if (*++fmt != 'S') 102*24621896SVasily Gorbik goto out; 103*24621896SVasily Gorbik p = buf + strlcat(buf, strsym(va_arg(args, void *)), sizeof(buf)); 104*24621896SVasily Gorbik break; 1059a78c70aSVasily Gorbik case 'l': 1069a78c70aSVasily Gorbik if (*++fmt != 'x' || end - p <= max(sizeof(long) * 2, pad)) 1079a78c70aSVasily Gorbik goto out; 1089a78c70aSVasily Gorbik p = as_hex(p, va_arg(args, unsigned long), pad); 1099a78c70aSVasily Gorbik break; 1109a78c70aSVasily Gorbik case 'x': 1119a78c70aSVasily Gorbik if (end - p <= max(sizeof(int) * 2, pad)) 1129a78c70aSVasily Gorbik goto out; 1139a78c70aSVasily Gorbik p = as_hex(p, va_arg(args, unsigned int), pad); 1149a78c70aSVasily Gorbik break; 1159a78c70aSVasily Gorbik default: 1169a78c70aSVasily Gorbik goto out; 1179a78c70aSVasily Gorbik } 1189a78c70aSVasily Gorbik } 1199a78c70aSVasily Gorbik out: 1209a78c70aSVasily Gorbik va_end(args); 1219a78c70aSVasily Gorbik sclp_early_printk(buf); 122724dc336SVasily Gorbik } 123724dc336SVasily Gorbik 124724dc336SVasily Gorbik void print_pgm_check_info(void) 125724dc336SVasily Gorbik { 1269a78c70aSVasily Gorbik unsigned long *gpregs = (unsigned long *)S390_lowcore.gpregs_save_area; 127724dc336SVasily Gorbik struct psw_bits *psw = &psw_bits(S390_lowcore.psw_save_area); 128724dc336SVasily Gorbik 1299a78c70aSVasily Gorbik decompressor_printk("Linux version %s\n", kernel_version); 1309a78c70aSVasily Gorbik decompressor_printk("Kernel fault: interruption code %04x ilc:%x\n", 1319a78c70aSVasily Gorbik S390_lowcore.pgm_code, S390_lowcore.pgm_ilc >> 1); 1329a78c70aSVasily Gorbik if (kaslr_enabled) 1339a78c70aSVasily Gorbik decompressor_printk("Kernel random base: %lx\n", __kaslr_offset); 134*24621896SVasily Gorbik decompressor_printk("PSW : %016lx %016lx (%pS)\n", 1359a78c70aSVasily Gorbik S390_lowcore.psw_save_area.mask, 136*24621896SVasily Gorbik S390_lowcore.psw_save_area.addr, 137*24621896SVasily Gorbik (void *)S390_lowcore.psw_save_area.addr); 1389a78c70aSVasily Gorbik decompressor_printk( 1399a78c70aSVasily Gorbik " R:%x T:%x IO:%x EX:%x Key:%x M:%x W:%x P:%x AS:%x CC:%x PM:%x RI:%x EA:%x\n", 1409a78c70aSVasily Gorbik psw->per, psw->dat, psw->io, psw->ext, psw->key, psw->mcheck, 1419a78c70aSVasily Gorbik psw->wait, psw->pstate, psw->as, psw->cc, psw->pm, psw->ri, 1429a78c70aSVasily Gorbik psw->eaba); 1439a78c70aSVasily Gorbik decompressor_printk("GPRS: %016lx %016lx %016lx %016lx\n", 1449a78c70aSVasily Gorbik gpregs[0], gpregs[1], gpregs[2], gpregs[3]); 1459a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n", 1469a78c70aSVasily Gorbik gpregs[4], gpregs[5], gpregs[6], gpregs[7]); 1479a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n", 1489a78c70aSVasily Gorbik gpregs[8], gpregs[9], gpregs[10], gpregs[11]); 1499a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n", 1509a78c70aSVasily Gorbik gpregs[12], gpregs[13], gpregs[14], gpregs[15]); 151724dc336SVasily Gorbik } 152