Cc: Alexander Graf <ag...@suse.de> Cc: Richard Henderson <r...@twiddle.net> Signed-off-by: Aurelien Jarno <aurel...@aurel32.net> --- target-s390x/cpu.h | 2 +- target-s390x/helper.h | 1 + target-s390x/insn-data.def | 2 ++ target-s390x/misc_helper.c | 19 +++++++++++++++++++ target-s390x/translate.c | 7 +++++++ 5 files changed, 30 insertions(+), 1 deletion(-)
diff --git a/target-s390x/cpu.h b/target-s390x/cpu.h index 35bfdec..3110c1f 100644 --- a/target-s390x/cpu.h +++ b/target-s390x/cpu.h @@ -174,7 +174,7 @@ static const uint64_t facilities_dw[] = { (0ULL << 59) | /* b 4: IDTE selective clearing when segtab invalidated */ (0ULL << 58) | /* b 5: IDTE selective clearing when regtab invalidated */ (0ULL << 57) | /* b 6: ASN-and-LX-reuse facility */ - (0ULL << 56) | /* b 7: Store-facility-list-extended facility */ + (1ULL << 56) | /* b 7: Store-facility-list-extended facility */ (0ULL << 55) | /* b 8: Enhanced-DAT facility */ (0ULL << 54) | /* b 9: Sense-running-status facility */ (0ULL << 53) | /* b10: Conditional-SSKE facility */ diff --git a/target-s390x/helper.h b/target-s390x/helper.h index e6f2afb..2dc01a0 100644 --- a/target-s390x/helper.h +++ b/target-s390x/helper.h @@ -79,6 +79,7 @@ DEF_HELPER_FLAGS_5(calc_cc, TCG_CALL_NO_RWG_SE, i32, env, i32, i64, i64, i64) DEF_HELPER_FLAGS_2(sfpc, TCG_CALL_NO_RWG, void, env, i64) DEF_HELPER_FLAGS_2(sfas, TCG_CALL_NO_WG, void, env, i64) DEF_HELPER_FLAGS_1(popcnt, TCG_CALL_NO_RWG_SE, i64, i64) +DEF_HELPER_2(stfle, i32, env, i64) #ifndef CONFIG_USER_ONLY DEF_HELPER_3(servc, i32, env, i64, i64) diff --git a/target-s390x/insn-data.def b/target-s390x/insn-data.def index 72c3a2e..fd45730 100644 --- a/target-s390x/insn-data.def +++ b/target-s390x/insn-data.def @@ -827,6 +827,8 @@ /* STORE CPU TIMER */ C(0xb209, STPT, S, Z, la2, 0, new, m1_64, stpt, 0) /* STORE FACILITY LIST */ + C(0xb2b0, STFLE, S, SFLE, 0, a2, 0, 0, stfle, 0) +/* STORE FACILITY LIST */ C(0xb2b1, STFL, S, Z, 0, 0, 0, 0, stfl, 0) /* STORE PREFIX */ C(0xb211, STPX, S, Z, la2, 0, new, m1_32, stpx, 0) diff --git a/target-s390x/misc_helper.c b/target-s390x/misc_helper.c index b375ab7..711f365 100644 --- a/target-s390x/misc_helper.c +++ b/target-s390x/misc_helper.c @@ -76,6 +76,25 @@ void HELPER(exception)(CPUS390XState *env, uint32_t excp) cpu_loop_exit(cs); } +/* Store faciliy list extended */ +uint32_t HELPER(stfle)(CPUS390XState *env, uint64_t dest) +{ + int nf = sizeof(facilities_dw) / sizeof(facilities_dw[0]); + int rf = (env->regs[0] & 0xff) + 1; + int i; + + for (i = 0; i < MIN(nf, rf); i++) { + cpu_stq_data(env, dest, facilities_dw[i]); + dest += 8; + } + + if (rf > nf) { + env->regs[0] = (env->regs[0] & ~0xff) | (nf - 1); + } + + return (rf < nf) ? 3 : 0; +} + #ifndef CONFIG_USER_ONLY void program_interrupt(CPUS390XState *env, uint32_t code, int ilen) diff --git a/target-s390x/translate.c b/target-s390x/translate.c index 542da53..78b8cdc 100644 --- a/target-s390x/translate.c +++ b/target-s390x/translate.c @@ -3382,6 +3382,13 @@ static ExitStatus op_stfl(DisasContext *s, DisasOps *o) return NO_EXIT; } +static ExitStatus op_stfle(DisasContext *s, DisasOps *o) +{ + gen_helper_stfle(cc_op, cpu_env, o->in2); + set_cc_static(s); + return NO_EXIT; +} + static ExitStatus op_stpt(DisasContext *s, DisasOps *o) { check_privileged(s); -- 2.1.4