xref: /kvm-unit-tests/lib/s390x/asm/facility.h (revision 1f08a91a41402b0e032ecce8ed1b5952cbfca0ea)
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