85 lines · c
1// SPDX-License-Identifier: GPL-2.0+2 3/*4 * Copyright 2018 IBM Corporation.5 */6 7#define __SANE_USERSPACE_TYPES__8 9#include <sys/types.h>10#include <stdint.h>11#include <unistd.h>12#include <signal.h>13#include <stdlib.h>14#include <string.h>15#include <stdio.h>16#include <sys/utsname.h>17#include "reg.h"18#include "utils.h"19#include "flush_utils.h"20 21static inline __u64 load(void *addr)22{23 __u64 tmp;24 25 asm volatile("ld %0,0(%1)" : "=r"(tmp) : "b"(addr));26 27 return tmp;28}29 30void syscall_loop(char *p, unsigned long iterations,31 unsigned long zero_size)32{33 for (unsigned long i = 0; i < iterations; i++) {34 for (unsigned long j = 0; j < zero_size; j += CACHELINE_SIZE)35 load(p + j);36 getppid();37 }38}39 40void syscall_loop_uaccess(char *p, unsigned long iterations,41 unsigned long zero_size)42{43 struct utsname utsname;44 45 for (unsigned long i = 0; i < iterations; i++) {46 for (unsigned long j = 0; j < zero_size; j += CACHELINE_SIZE)47 load(p + j);48 uname(&utsname);49 }50}51 52static void sigill_handler(int signr, siginfo_t *info, void *unused)53{54 static int warned;55 ucontext_t *ctx = (ucontext_t *)unused;56 unsigned long *pc = &UCONTEXT_NIA(ctx);57 58 /* mtspr 3,RS to check for move to DSCR below */59 if ((*((unsigned int *)*pc) & 0xfc1fffff) == 0x7c0303a6) {60 if (!warned++)61 printf("WARNING: Skipping over dscr setup. Consider running 'ppc64_cpu --dscr=1' manually.\n");62 *pc += 4;63 } else {64 printf("SIGILL at %p\n", pc);65 abort();66 }67}68 69void set_dscr(unsigned long val)70{71 static int init;72 struct sigaction sa;73 74 if (!init) {75 memset(&sa, 0, sizeof(sa));76 sa.sa_sigaction = sigill_handler;77 sa.sa_flags = SA_SIGINFO;78 if (sigaction(SIGILL, &sa, NULL))79 perror("sigill_handler");80 init = 1;81 }82 83 mtspr(SPRN_DSCR, val);84}85