1
2
3
4
5
6
7#ifndef __ASM_FACILITY_H
8#define __ASM_FACILITY_H
9
10#include <linux/string.h>
11#include <linux/preempt.h>
12#include <asm/lowcore.h>
13
14#define MAX_FACILITY_BIT (256*8)
15
16static inline int __test_facility(unsigned long nr, void *facilities)
17{
18 unsigned char *ptr;
19
20 if (nr >= MAX_FACILITY_BIT)
21 return 0;
22 ptr = (unsigned char *) facilities + (nr >> 3);
23 return (*ptr & (0x80 >> (nr & 7))) != 0;
24}
25
26
27
28
29
30
31static inline int test_facility(unsigned long nr)
32{
33 return __test_facility(nr, &S390_lowcore.stfle_fac_list);
34}
35
36
37
38
39
40
41static inline void stfle(u64 *stfle_fac_list, int size)
42{
43 unsigned long nr;
44
45 preempt_disable();
46 asm volatile(
47 " .insn s,0xb2b10000,0(0)\n"
48 "0:\n"
49 EX_TABLE(0b, 0b)
50 : "+m" (S390_lowcore.stfl_fac_list));
51 nr = 4;
52 memcpy(stfle_fac_list, &S390_lowcore.stfl_fac_list, 4);
53 if (S390_lowcore.stfl_fac_list & 0x01000000) {
54
55 register unsigned long reg0 asm("0") = size - 1;
56
57 asm volatile(".insn s,0xb2b00000,0(%1)"
58 : "+d" (reg0)
59 : "a" (stfle_fac_list)
60 : "memory", "cc");
61 nr = (reg0 + 1) * 8;
62 }
63 memset((char *) stfle_fac_list + nr, 0, size * 8 - nr);
64 preempt_enable();
65}
66
67#endif
68