1724dc336SVasily Gorbik // SPDX-License-Identifier: GPL-2.0
2724dc336SVasily Gorbik #include <linux/kernel.h>
3c0891ac1SAlexey Dobriyan #include <linux/stdarg.h>
4724dc336SVasily Gorbik #include <linux/string.h>
59a78c70aSVasily Gorbik #include <linux/ctype.h>
68977ab65SVasily Gorbik #include <asm/stacktrace.h>
7ba1a6be9SVasily Gorbik #include <asm/boot_data.h>
8724dc336SVasily Gorbik #include <asm/lowcore.h>
93ca8b855SVasily Gorbik #include <asm/setup.h>
10724dc336SVasily Gorbik #include <asm/sclp.h>
11ba1a6be9SVasily Gorbik #include <asm/uv.h>
12724dc336SVasily Gorbik #include "boot.h"
13724dc336SVasily Gorbik
14724dc336SVasily Gorbik const char hex_asc[] = "0123456789abcdef";
15724dc336SVasily Gorbik
as_hex(char * dst,unsigned long val,int pad)169a78c70aSVasily Gorbik static char *as_hex(char *dst, unsigned long val, int pad)
17724dc336SVasily Gorbik {
189a78c70aSVasily Gorbik char *p, *end = p = dst + max(pad, (int)__fls(val | 1) / 4 + 1);
199a78c70aSVasily Gorbik
209a78c70aSVasily Gorbik for (*p-- = 0; p >= dst; val >>= 4)
219a78c70aSVasily Gorbik *p-- = hex_asc[val & 0x0f];
229a78c70aSVasily Gorbik return end;
23724dc336SVasily Gorbik }
24724dc336SVasily Gorbik
symstart(char * p)2524621896SVasily Gorbik static char *symstart(char *p)
2624621896SVasily Gorbik {
2724621896SVasily Gorbik while (*p)
2824621896SVasily Gorbik p--;
2924621896SVasily Gorbik return p + 1;
3024621896SVasily Gorbik }
3124621896SVasily Gorbik
findsym(unsigned long ip,unsigned short * off,unsigned short * len)3224621896SVasily Gorbik static noinline char *findsym(unsigned long ip, unsigned short *off, unsigned short *len)
3324621896SVasily Gorbik {
3424621896SVasily Gorbik /* symbol entries are in a form "10000 c4 startup\0" */
3524621896SVasily Gorbik char *a = _decompressor_syms_start;
3624621896SVasily Gorbik char *b = _decompressor_syms_end;
3724621896SVasily Gorbik unsigned long start;
3824621896SVasily Gorbik unsigned long size;
3924621896SVasily Gorbik char *pivot;
4024621896SVasily Gorbik char *endp;
4124621896SVasily Gorbik
4224621896SVasily Gorbik while (a < b) {
4324621896SVasily Gorbik pivot = symstart(a + (b - a) / 2);
4424621896SVasily Gorbik start = simple_strtoull(pivot, &endp, 16);
4524621896SVasily Gorbik size = simple_strtoull(endp + 1, &endp, 16);
4624621896SVasily Gorbik if (ip < start) {
4724621896SVasily Gorbik b = pivot;
4824621896SVasily Gorbik continue;
4924621896SVasily Gorbik }
5024621896SVasily Gorbik if (ip > start + size) {
5124621896SVasily Gorbik a = pivot + strlen(pivot) + 1;
5224621896SVasily Gorbik continue;
5324621896SVasily Gorbik }
5424621896SVasily Gorbik *off = ip - start;
5524621896SVasily Gorbik *len = size;
5624621896SVasily Gorbik return endp + 1;
5724621896SVasily Gorbik }
5824621896SVasily Gorbik return NULL;
5924621896SVasily Gorbik }
6024621896SVasily Gorbik
strsym(void * ip)6124621896SVasily Gorbik static noinline char *strsym(void *ip)
6224621896SVasily Gorbik {
6324621896SVasily Gorbik static char buf[64];
6424621896SVasily Gorbik unsigned short off;
6524621896SVasily Gorbik unsigned short len;
6624621896SVasily Gorbik char *p;
6724621896SVasily Gorbik
6824621896SVasily Gorbik p = findsym((unsigned long)ip, &off, &len);
6924621896SVasily Gorbik if (p) {
7024621896SVasily Gorbik strncpy(buf, p, sizeof(buf));
7124621896SVasily Gorbik /* reserve 15 bytes for offset/len in symbol+0x1234/0x1234 */
7224621896SVasily Gorbik p = buf + strnlen(buf, sizeof(buf) - 15);
7324621896SVasily Gorbik strcpy(p, "+0x");
7424621896SVasily Gorbik p = as_hex(p + 3, off, 0);
7524621896SVasily Gorbik strcpy(p, "/0x");
7624621896SVasily Gorbik as_hex(p + 3, len, 0);
7724621896SVasily Gorbik } else {
7824621896SVasily Gorbik as_hex(buf, (unsigned long)ip, 16);
7924621896SVasily Gorbik }
8024621896SVasily Gorbik return buf;
8124621896SVasily Gorbik }
8224621896SVasily Gorbik
decompressor_printk(const char * fmt,...)839a78c70aSVasily Gorbik void decompressor_printk(const char *fmt, ...)
84724dc336SVasily Gorbik {
859a78c70aSVasily Gorbik char buf[1024] = { 0 };
869a78c70aSVasily Gorbik char *end = buf + sizeof(buf) - 1; /* make sure buf is 0 terminated */
879a78c70aSVasily Gorbik unsigned long pad;
889a78c70aSVasily Gorbik char *p = buf;
899a78c70aSVasily Gorbik va_list args;
909a78c70aSVasily Gorbik
919a78c70aSVasily Gorbik va_start(args, fmt);
929a78c70aSVasily Gorbik for (; p < end && *fmt; fmt++) {
939a78c70aSVasily Gorbik if (*fmt != '%') {
949a78c70aSVasily Gorbik *p++ = *fmt;
959a78c70aSVasily Gorbik continue;
969a78c70aSVasily Gorbik }
979a78c70aSVasily Gorbik pad = isdigit(*++fmt) ? simple_strtol(fmt, (char **)&fmt, 10) : 0;
989a78c70aSVasily Gorbik switch (*fmt) {
999a78c70aSVasily Gorbik case 's':
1009a78c70aSVasily Gorbik p = buf + strlcat(buf, va_arg(args, char *), sizeof(buf));
1019a78c70aSVasily Gorbik break;
10224621896SVasily Gorbik case 'p':
10324621896SVasily Gorbik if (*++fmt != 'S')
10424621896SVasily Gorbik goto out;
10524621896SVasily Gorbik p = buf + strlcat(buf, strsym(va_arg(args, void *)), sizeof(buf));
10624621896SVasily Gorbik break;
1079a78c70aSVasily Gorbik case 'l':
1089a78c70aSVasily Gorbik if (*++fmt != 'x' || end - p <= max(sizeof(long) * 2, pad))
1099a78c70aSVasily Gorbik goto out;
1109a78c70aSVasily Gorbik p = as_hex(p, va_arg(args, unsigned long), pad);
1119a78c70aSVasily Gorbik break;
1129a78c70aSVasily Gorbik case 'x':
1139a78c70aSVasily Gorbik if (end - p <= max(sizeof(int) * 2, pad))
1149a78c70aSVasily Gorbik goto out;
1159a78c70aSVasily Gorbik p = as_hex(p, va_arg(args, unsigned int), pad);
1169a78c70aSVasily Gorbik break;
1179a78c70aSVasily Gorbik default:
1189a78c70aSVasily Gorbik goto out;
1199a78c70aSVasily Gorbik }
1209a78c70aSVasily Gorbik }
1219a78c70aSVasily Gorbik out:
1229a78c70aSVasily Gorbik va_end(args);
1239a78c70aSVasily Gorbik sclp_early_printk(buf);
124724dc336SVasily Gorbik }
125724dc336SVasily Gorbik
print_stacktrace(unsigned long sp)126f913a660SVasily Gorbik void print_stacktrace(unsigned long sp)
1278977ab65SVasily Gorbik {
128256d78d0SAlexander Egorenkov struct stack_info boot_stack = { STACK_TYPE_TASK, (unsigned long)_stack_start,
129256d78d0SAlexander Egorenkov (unsigned long)_stack_end };
1308977ab65SVasily Gorbik bool first = true;
1318977ab65SVasily Gorbik
1328977ab65SVasily Gorbik decompressor_printk("Call Trace:\n");
1338977ab65SVasily Gorbik while (!(sp & 0x7) && on_stack(&boot_stack, sp, sizeof(struct stack_frame))) {
1348977ab65SVasily Gorbik struct stack_frame *sf = (struct stack_frame *)sp;
1358977ab65SVasily Gorbik
1368977ab65SVasily Gorbik decompressor_printk(first ? "(sp:%016lx [<%016lx>] %pS)\n" :
1378977ab65SVasily Gorbik " sp:%016lx [<%016lx>] %pS\n",
1388977ab65SVasily Gorbik sp, sf->gprs[8], (void *)sf->gprs[8]);
1398977ab65SVasily Gorbik if (sf->back_chain <= sp)
1408977ab65SVasily Gorbik break;
1418977ab65SVasily Gorbik sp = sf->back_chain;
1428977ab65SVasily Gorbik first = false;
1438977ab65SVasily Gorbik }
1448977ab65SVasily Gorbik }
1458977ab65SVasily Gorbik
print_pgm_check_info(void)146724dc336SVasily Gorbik void print_pgm_check_info(void)
147724dc336SVasily Gorbik {
1489a78c70aSVasily Gorbik unsigned long *gpregs = (unsigned long *)S390_lowcore.gpregs_save_area;
149724dc336SVasily Gorbik struct psw_bits *psw = &psw_bits(S390_lowcore.psw_save_area);
150724dc336SVasily Gorbik
1519a78c70aSVasily Gorbik decompressor_printk("Linux version %s\n", kernel_version);
152ba1a6be9SVasily Gorbik if (!is_prot_virt_guest() && early_command_line[0])
153ba1a6be9SVasily Gorbik decompressor_printk("Kernel command line: %s\n", early_command_line);
1549a78c70aSVasily Gorbik decompressor_printk("Kernel fault: interruption code %04x ilc:%x\n",
1559a78c70aSVasily Gorbik S390_lowcore.pgm_code, S390_lowcore.pgm_ilc >> 1);
156*bb87190cSHeiko Carstens if (kaslr_enabled())
1579a78c70aSVasily Gorbik decompressor_printk("Kernel random base: %lx\n", __kaslr_offset);
15824621896SVasily Gorbik decompressor_printk("PSW : %016lx %016lx (%pS)\n",
1599a78c70aSVasily Gorbik S390_lowcore.psw_save_area.mask,
16024621896SVasily Gorbik S390_lowcore.psw_save_area.addr,
16124621896SVasily Gorbik (void *)S390_lowcore.psw_save_area.addr);
1629a78c70aSVasily Gorbik decompressor_printk(
1639a78c70aSVasily 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",
1649a78c70aSVasily Gorbik psw->per, psw->dat, psw->io, psw->ext, psw->key, psw->mcheck,
1659a78c70aSVasily Gorbik psw->wait, psw->pstate, psw->as, psw->cc, psw->pm, psw->ri,
1669a78c70aSVasily Gorbik psw->eaba);
1679a78c70aSVasily Gorbik decompressor_printk("GPRS: %016lx %016lx %016lx %016lx\n",
1689a78c70aSVasily Gorbik gpregs[0], gpregs[1], gpregs[2], gpregs[3]);
1699a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n",
1709a78c70aSVasily Gorbik gpregs[4], gpregs[5], gpregs[6], gpregs[7]);
1719a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n",
1729a78c70aSVasily Gorbik gpregs[8], gpregs[9], gpregs[10], gpregs[11]);
1739a78c70aSVasily Gorbik decompressor_printk(" %016lx %016lx %016lx %016lx\n",
1749a78c70aSVasily Gorbik gpregs[12], gpregs[13], gpregs[14], gpregs[15]);
175f913a660SVasily Gorbik print_stacktrace(S390_lowcore.gpregs_save_area[15]);
176ba1a6be9SVasily Gorbik decompressor_printk("Last Breaking-Event-Address:\n");
17726c21aa4SSven Schnelle decompressor_printk(" [<%016lx>] %pS\n", (unsigned long)S390_lowcore.pgm_last_break,
17826c21aa4SSven Schnelle (void *)S390_lowcore.pgm_last_break);
179724dc336SVasily Gorbik }
180