hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
// SPDX-License-Identifier: GPL-2.0
/*
 *    Copyright IBM Corp. 2016
 */
#include <linux/kernel.h>
#include <asm/processor.h>
#include <asm/facility.h>
#include <asm/lowcore.h>
#include <asm/sclp.h>
#include "boot.h"
 
/*
 * The code within this file will be called very early. It may _not_
 * access anything within the bss section, since that is not cleared
 * yet and may contain data (e.g. initrd) that must be saved by other
 * code.
 * For temporary objects the stack (16k) should be used.
 */
 
static unsigned long als[] = { FACILITIES_ALS };
 
static void u16_to_hex(char *str, u16 val)
{
   int i, num;
 
   for (i = 1; i <= 4; i++) {
       num = (val >> (16 - 4 * i)) & 0xf;
       if (num >= 10)
           num += 7;
       *str++ = '0' + num;
   }
   *str = '\0';
}
 
static void print_machine_type(void)
{
   static char mach_str[80] = "Detected machine-type number: ";
   char type_str[5];
   struct cpuid id;
 
   get_cpu_id(&id);
   u16_to_hex(type_str, id.machine);
   strcat(mach_str, type_str);
   strcat(mach_str, "\n");
   sclp_early_printk(mach_str);
}
 
static void u16_to_decimal(char *str, u16 val)
{
   int div = 1;
 
   while (div * 10 <= val)
       div *= 10;
   while (div) {
       *str++ = '0' + val / div;
       val %= div;
       div /= 10;
   }
   *str = '\0';
}
 
void print_missing_facilities(void)
{
   static char als_str[80] = "Missing facilities: ";
   unsigned long val;
   char val_str[6];
   int i, j, first;
 
   first = 1;
   for (i = 0; i < ARRAY_SIZE(als); i++) {
       val = ~S390_lowcore.stfle_fac_list[i] & als[i];
       for (j = 0; j < BITS_PER_LONG; j++) {
           if (!(val & (1UL << (BITS_PER_LONG - 1 - j))))
               continue;
           if (!first)
               strcat(als_str, ",");
           /*
            * Make sure we stay within one line. Consider that
            * each facility bit adds up to five characters and
            * z/VM adds a four character prefix.
            */
           if (strlen(als_str) > 70) {
               strcat(als_str, "\n");
               sclp_early_printk(als_str);
               *als_str = '\0';
           }
           u16_to_decimal(val_str, i * BITS_PER_LONG + j);
           strcat(als_str, val_str);
           first = 0;
       }
   }
   strcat(als_str, "\n");
   sclp_early_printk(als_str);
}
 
static void facility_mismatch(void)
{
   sclp_early_printk("The Linux kernel requires more recent processor hardware\n");
   print_machine_type();
   print_missing_facilities();
   sclp_early_printk("See Principles of Operations for facility bits\n");
   disabled_wait();
}
 
void verify_facilities(void)
{
   int i;
 
   __stfle(S390_lowcore.stfle_fac_list, ARRAY_SIZE(S390_lowcore.stfle_fac_list));
   for (i = 0; i < ARRAY_SIZE(als); i++) {
       if ((S390_lowcore.stfle_fac_list[i] & als[i]) != als[i])
           facility_mismatch();
   }
}