tools/testing/selftests/x86/pkey-helpers.h

   1 #ifndef _PKEYS_HELPER_H
   2 #define _PKEYS_HELPER_H
   3 #define _GNU_SOURCE
   4 #include <string.h>
   5 #include <stdarg.h>
   6 #include <stdio.h>
   7 #include <stdint.h>
   8 #include <stdbool.h>
   9 #include <signal.h>
  10 #include <assert.h>
  11 #include <stdlib.h>
  12 #include <ucontext.h>
  13 #include <sys/mman.h>
  14
  15 #define NR_PKEYS 16
  16 #define PKRU_BITS_PER_PKEY 2
  17
  18 #ifndef DEBUG_LEVEL
  19 #define DEBUG_LEVEL 0
  20 #endif
  21 #define DPRINT_IN_SIGNAL_BUF_SIZE 4096
  22 extern int dprint_in_signal;
  23 extern char dprint_in_signal_buffer[DPRINT_IN_SIGNAL_BUF_SIZE];
  24 static inline void sigsafe_printf(const char *format, ...)
  25 {
  26         va_list ap;
  27
  28         va_start(ap, format);
  29         if (!dprint_in_signal) {
  30                 vprintf(format, ap);
  31         } else {
  32                 int len = vsnprintf(dprint_in_signal_buffer,
  33                                     DPRINT_IN_SIGNAL_BUF_SIZE,
  34                                     format, ap);
  35                 /*
  36                  * len is amount that would have been printed,
  37                  * but actual write is truncated at BUF_SIZE.
  38                  */
  39                 if (len > DPRINT_IN_SIGNAL_BUF_SIZE)
  40                         len = DPRINT_IN_SIGNAL_BUF_SIZE;
  41                 write(1, dprint_in_signal_buffer, len);
  42         }
  43         va_end(ap);
  44 }
  45 #define dprintf_level(level, args...) do {      \
  46         if (level <= DEBUG_LEVEL)               \
  47                 sigsafe_printf(args);           \
  48         fflush(NULL);                           \
  49 } while (0)
  50 #define dprintf0(args...) dprintf_level(0, args)
  51 #define dprintf1(args...) dprintf_level(1, args)
  52 #define dprintf2(args...) dprintf_level(2, args)
  53 #define dprintf3(args...) dprintf_level(3, args)
  54 #define dprintf4(args...) dprintf_level(4, args)
  55
  56 extern unsigned int shadow_pkru;
  57 static inline unsigned int __rdpkru(void)
  58 {
  59         unsigned int eax, edx;
  60         unsigned int ecx = 0;
  61         unsigned int pkru;
  62
  63         asm volatile(".byte 0x0f,0x01,0xee\n\t"
  64                      : "=a" (eax), "=d" (edx)
  65                      : "c" (ecx));
  66         pkru = eax;
  67         return pkru;
  68 }
  69
  70 static inline unsigned int _rdpkru(int line)
  71 {
  72         unsigned int pkru = __rdpkru();
  73
  74         dprintf4("rdpkru(line=%d) pkru: %x shadow: %x\n",
  75                         line, pkru, shadow_pkru);
  76         assert(pkru == shadow_pkru);
  77
  78         return pkru;
  79 }
  80
  81 #define rdpkru() _rdpkru(__LINE__)
  82
  83 static inline void __wrpkru(unsigned int pkru)
  84 {
  85         unsigned int eax = pkru;
  86         unsigned int ecx = 0;
  87         unsigned int edx = 0;
  88
  89         dprintf4("%s() changing %08x to %08x\n", __func__, __rdpkru(), pkru);
  90         asm volatile(".byte 0x0f,0x01,0xef\n\t"
  91                      : : "a" (eax), "c" (ecx), "d" (edx));
  92         assert(pkru == __rdpkru());
  93 }
  94
  95 static inline void wrpkru(unsigned int pkru)
  96 {
  97         dprintf4("%s() changing %08x to %08x\n", __func__, __rdpkru(), pkru);
  98         /* will do the shadow check for us: */
  99         rdpkru();
 100         __wrpkru(pkru);
 101         shadow_pkru = pkru;
 102         dprintf4("%s(%08x) pkru: %08x\n", __func__, pkru, __rdpkru());
 103 }
 104
 105 /*
 106  * These are technically racy. since something could
 107  * change PKRU between the read and the write.
 108  */
 109 static inline void __pkey_access_allow(int pkey, int do_allow)
 110 {
 111         unsigned int pkru = rdpkru();
 112         int bit = pkey * 2;
 113
 114         if (do_allow)
 115                 pkru &= (1<<bit);
 116         else
 117                 pkru |= (1<<bit);
 118
 119         dprintf4("pkru now: %08x\n", rdpkru());
 120         wrpkru(pkru);
 121 }
 122
 123 static inline void __pkey_write_allow(int pkey, int do_allow_write)
 124 {
 125         long pkru = rdpkru();
 126         int bit = pkey * 2 + 1;
 127
 128         if (do_allow_write)
 129                 pkru &= (1<<bit);
 130         else
 131                 pkru |= (1<<bit);
 132
 133         wrpkru(pkru);
 134         dprintf4("pkru now: %08x\n", rdpkru());
 135 }
 136
 137 #define PROT_PKEY0     0x10            /* protection key value (bit 0) */
 138 #define PROT_PKEY1     0x20            /* protection key value (bit 1) */
 139 #define PROT_PKEY2     0x40            /* protection key value (bit 2) */
 140 #define PROT_PKEY3     0x80            /* protection key value (bit 3) */
 141
 142 #define PAGE_SIZE 4096
 143 #define MB      (1<<20)
 144
 145 static inline void __cpuid(unsigned int *eax, unsigned int *ebx,
 146                 unsigned int *ecx, unsigned int *edx)
 147 {
 148         /* ecx is often an input as well as an output. */
 149         asm volatile(
 150                 "cpuid;"
 151                 : "=a" (*eax),
 152                   "=b" (*ebx),
 153                   "=c" (*ecx),
 154                   "=d" (*edx)
 155                 : "0" (*eax), "2" (*ecx));
 156 }
 157
 158 /* Intel-defined CPU features, CPUID level 0x00000007:0 (ecx) */
 159 #define X86_FEATURE_PKU        (1<<3) /* Protection Keys for Userspace */
 160 #define X86_FEATURE_OSPKE      (1<<4) /* OS Protection Keys Enable */
 161
 162 static inline int cpu_has_pku(void)
 163 {
 164         unsigned int eax;
 165         unsigned int ebx;
 166         unsigned int ecx;
 167         unsigned int edx;
 168
 169         eax = 0x7;
 170         ecx = 0x0;
 171         __cpuid(&eax, &ebx, &ecx, &edx);
 172
 173         if (!(ecx & X86_FEATURE_PKU)) {
 174                 dprintf2("cpu does not have PKU\n");
 175                 return 0;
 176         }
 177         if (!(ecx & X86_FEATURE_OSPKE)) {
 178                 dprintf2("cpu does not have OSPKE\n");
 179                 return 0;
 180         }
 181         return 1;
 182 }
 183
 184 #define XSTATE_PKRU_BIT (9)
 185 #define XSTATE_PKRU     0x200
 186
 187 int pkru_xstate_offset(void)
 188 {
 189         unsigned int eax;
 190         unsigned int ebx;
 191         unsigned int ecx;
 192         unsigned int edx;
 193         int xstate_offset;
 194         int xstate_size;
 195         unsigned long XSTATE_CPUID = 0xd;
 196         int leaf;
 197
 198         /* assume that XSTATE_PKRU is set in XCR0 */
 199         leaf = XSTATE_PKRU_BIT;
 200         {
 201                 eax = XSTATE_CPUID;
 202                 ecx = leaf;
 203                 __cpuid(&eax, &ebx, &ecx, &edx);
 204
 205                 if (leaf == XSTATE_PKRU_BIT) {
 206                         xstate_offset = ebx;
 207                         xstate_size = eax;
 208                 }
 209         }
 210
 211         if (xstate_size == 0) {
 212                 printf("could not find size/offset of PKRU in xsave state\n");
 213                 return 0;
 214         }
 215
 216         return xstate_offset;
 217 }
 218
 219 #endif /* _PKEYS_HELPER_H */