16c9f99dfSJanosch Frank /* SPDX-License-Identifier: GPL-2.0-only */
228f482bdSDavid Hildenbrand /*
328f482bdSDavid Hildenbrand * Copyright (c) 2017 Red Hat Inc
428f482bdSDavid Hildenbrand *
528f482bdSDavid Hildenbrand * Authors:
628f482bdSDavid Hildenbrand * David Hildenbrand <david@redhat.com>
728f482bdSDavid Hildenbrand */
8eb5a1bbaSCornelia Huck #ifndef _ASMS390X_FACILITY_H_
9eb5a1bbaSCornelia Huck #define _ASMS390X_FACILITY_H_
1028f482bdSDavid Hildenbrand
1128f482bdSDavid Hildenbrand #include <libcflat.h>
1228f482bdSDavid Hildenbrand #include <asm/facility.h>
1328f482bdSDavid Hildenbrand #include <asm/arch_def.h>
142989246eSJanosch Frank #include <bitops.h>
157c4e732dSJanis Schoetterl-Glausch #include <sclp.h>
1628f482bdSDavid Hildenbrand
176abbd4f0SDavid Hildenbrand #define NB_STFL_DOUBLEWORDS 32
186abbd4f0SDavid Hildenbrand extern uint64_t stfl_doublewords[];
1928f482bdSDavid Hildenbrand
test_facility(int nr)2028f482bdSDavid Hildenbrand static inline bool test_facility(int nr)
2128f482bdSDavid Hildenbrand {
222989246eSJanosch Frank return test_bit_inv(nr, stfl_doublewords);
2328f482bdSDavid Hildenbrand }
2428f482bdSDavid Hildenbrand
stfl(void)2528f482bdSDavid Hildenbrand static inline void stfl(void)
2628f482bdSDavid Hildenbrand {
2716c1768eSClaudio Imbrenda asm volatile(" stfl 0(0)\n" : : : "memory");
2828f482bdSDavid Hildenbrand }
2928f482bdSDavid Hildenbrand
stfle(uint64_t * fac,unsigned int nb_doublewords)30*708ec6dbSNina Schoetterl-Glausch static inline unsigned int stfle(uint64_t *fac, unsigned int nb_doublewords)
3128f482bdSDavid Hildenbrand {
326abbd4f0SDavid 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");
36*708ec6dbSNina Schoetterl-Glausch return r0 + 1;
37*708ec6dbSNina Schoetterl-Glausch }
38*708ec6dbSNina Schoetterl-Glausch
stfle_size(void)39*708ec6dbSNina Schoetterl-Glausch static inline unsigned long stfle_size(void)
40*708ec6dbSNina Schoetterl-Glausch {
41*708ec6dbSNina Schoetterl-Glausch uint64_t dummy;
42*708ec6dbSNina Schoetterl-Glausch
43*708ec6dbSNina Schoetterl-Glausch return stfle(&dummy, 1);
4428f482bdSDavid Hildenbrand }
4528f482bdSDavid Hildenbrand
setup_facilities(void)4628f482bdSDavid Hildenbrand static inline void setup_facilities(void)
4728f482bdSDavid Hildenbrand {
4828f482bdSDavid Hildenbrand stfl();
49cd719531SJanis Schoetterl-Glausch memcpy(stfl_doublewords, &lowcore.stfl, sizeof(lowcore.stfl));
5028f482bdSDavid Hildenbrand if (test_facility(7))
516abbd4f0SDavid Hildenbrand stfle(stfl_doublewords, NB_STFL_DOUBLEWORDS);
5228f482bdSDavid Hildenbrand }
5328f482bdSDavid Hildenbrand
547c4e732dSJanis Schoetterl-Glausch enum supp_on_prot_facility {
557c4e732dSJanis Schoetterl-Glausch SOP_NONE,
567c4e732dSJanis Schoetterl-Glausch SOP_BASIC,
577c4e732dSJanis Schoetterl-Glausch SOP_ENHANCED_1,
587c4e732dSJanis Schoetterl-Glausch SOP_ENHANCED_2,
597c4e732dSJanis Schoetterl-Glausch };
607c4e732dSJanis Schoetterl-Glausch
get_supp_on_prot_facility(void)617c4e732dSJanis Schoetterl-Glausch static inline enum supp_on_prot_facility get_supp_on_prot_facility(void)
627c4e732dSJanis Schoetterl-Glausch {
637c4e732dSJanis Schoetterl-Glausch if (sclp_facilities.has_esop) {
647c4e732dSJanis Schoetterl-Glausch if (test_facility(131)) /* side-effect-access facility */
657c4e732dSJanis Schoetterl-Glausch return SOP_ENHANCED_2;
667c4e732dSJanis Schoetterl-Glausch else
677c4e732dSJanis Schoetterl-Glausch return SOP_ENHANCED_1;
687c4e732dSJanis Schoetterl-Glausch }
697c4e732dSJanis Schoetterl-Glausch if (sclp_facilities.has_sop)
707c4e732dSJanis Schoetterl-Glausch return SOP_BASIC;
717c4e732dSJanis Schoetterl-Glausch return SOP_NONE;
727c4e732dSJanis Schoetterl-Glausch }
737c4e732dSJanis Schoetterl-Glausch
7428f482bdSDavid Hildenbrand #endif
75