128f482bdSDavid Hildenbrand /* 228f482bdSDavid Hildenbrand * Copyright (c) 2017 Red Hat Inc 328f482bdSDavid Hildenbrand * 428f482bdSDavid Hildenbrand * Authors: 528f482bdSDavid Hildenbrand * David Hildenbrand <david@redhat.com> 628f482bdSDavid Hildenbrand * 728f482bdSDavid Hildenbrand * This code is free software; you can redistribute it and/or modify it 828f482bdSDavid Hildenbrand * under the terms of the GNU Library General Public License version 2. 928f482bdSDavid Hildenbrand */ 1028f482bdSDavid Hildenbrand #ifndef _ASM_S390X_FACILITY_H_ 1128f482bdSDavid Hildenbrand #define _ASM_S390X_FACILITY_H_ 1228f482bdSDavid Hildenbrand 1328f482bdSDavid Hildenbrand #include <libcflat.h> 1428f482bdSDavid Hildenbrand #include <asm/facility.h> 1528f482bdSDavid Hildenbrand #include <asm/arch_def.h> 1628f482bdSDavid Hildenbrand 17*6abbd4f0SDavid Hildenbrand #define NB_STFL_DOUBLEWORDS 32 18*6abbd4f0SDavid Hildenbrand extern uint64_t stfl_doublewords[]; 1928f482bdSDavid Hildenbrand 2028f482bdSDavid Hildenbrand static inline bool test_facility(int nr) 2128f482bdSDavid Hildenbrand { 22*6abbd4f0SDavid Hildenbrand return stfl_doublewords[nr / 64] & (0x8000000000000000UL >> (nr % 64)); 2328f482bdSDavid Hildenbrand } 2428f482bdSDavid Hildenbrand 2528f482bdSDavid Hildenbrand static inline void stfl(void) 2628f482bdSDavid Hildenbrand { 2716c1768eSClaudio Imbrenda asm volatile(" stfl 0(0)\n" : : : "memory"); 2828f482bdSDavid Hildenbrand } 2928f482bdSDavid Hildenbrand 30*6abbd4f0SDavid Hildenbrand static inline void stfle(uint64_t *fac, unsigned int nb_doublewords) 3128f482bdSDavid Hildenbrand { 32*6abbd4f0SDavid Hildenbrand register unsigned long r0 asm("0") = nb_doublewords - 1; 3328f482bdSDavid Hildenbrand 3428f482bdSDavid Hildenbrand asm volatile(" .insn s,0xb2b00000,0(%1)\n" 3528f482bdSDavid Hildenbrand : "+d" (r0) : "a" (fac) : "memory", "cc"); 3628f482bdSDavid Hildenbrand } 3728f482bdSDavid Hildenbrand 3828f482bdSDavid Hildenbrand static inline void setup_facilities(void) 3928f482bdSDavid Hildenbrand { 4028f482bdSDavid Hildenbrand struct lowcore *lc = NULL; 4128f482bdSDavid Hildenbrand 4228f482bdSDavid Hildenbrand stfl(); 43*6abbd4f0SDavid Hildenbrand memcpy(stfl_doublewords, &lc->stfl, sizeof(lc->stfl)); 4428f482bdSDavid Hildenbrand if (test_facility(7)) 45*6abbd4f0SDavid Hildenbrand stfle(stfl_doublewords, NB_STFL_DOUBLEWORDS); 4628f482bdSDavid Hildenbrand } 4728f482bdSDavid Hildenbrand 4828f482bdSDavid Hildenbrand #endif 49