[qemu.git] / target-s390x / cc_helper.c

/*
 *  S/390 condition code helper routines
 *
 *  Copyright (c) 2009 Ulrich Hecht
 *  Copyright (c) 2009 Alexander Graf
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 */

#include "cpu.h"
#include "exec/helper-proto.h"
#include "qemu/host-utils.h"

/* #define DEBUG_HELPER */
#ifdef DEBUG_HELPER
#define HELPER_LOG(x...) qemu_log(x)
#else
#define HELPER_LOG(x...)
#endif

static uint32_t cc_calc_ltgt_32(int32_t src, int32_t dst)
{
    if (src == dst) {
        return 0;
    } else if (src < dst) {
        return 1;
    } else {
        return 2;
    }
}

static uint32_t cc_calc_ltgt0_32(int32_t dst)
{
    return cc_calc_ltgt_32(dst, 0);
}

static uint32_t cc_calc_ltgt_64(int64_t src, int64_t dst)
{
    if (src == dst) {
        return 0;
    } else if (src < dst) {
        return 1;
    } else {
        return 2;
    }
}

static uint32_t cc_calc_ltgt0_64(int64_t dst)
{
    return cc_calc_ltgt_64(dst, 0);
}

static uint32_t cc_calc_ltugtu_32(uint32_t src, uint32_t dst)
{
    if (src == dst) {
        return 0;
    } else if (src < dst) {
        return 1;
    } else {
        return 2;
    }
}

static uint32_t cc_calc_ltugtu_64(uint64_t src, uint64_t dst)
{
    if (src == dst) {
        return 0;
    } else if (src < dst) {
        return 1;
    } else {
        return 2;
    }
}

static uint32_t cc_calc_tm_32(uint32_t val, uint32_t mask)
{
    uint32_t r = val & mask;

    if (r == 0) {
        return 0;
    } else if (r == mask) {
        return 3;
    } else {
        return 1;
    }
}

static uint32_t cc_calc_tm_64(uint64_t val, uint64_t mask)
{
    uint64_t r = val & mask;

    if (r == 0) {
        return 0;
    } else if (r == mask) {
        return 3;
    } else {
        int top = clz64(mask);
        if ((int64_t)(val << top) < 0) {
            return 2;
        } else {
            return 1;
        }
    }
}

static uint32_t cc_calc_nz(uint64_t dst)
{
    return !!dst;
}

static uint32_t cc_calc_add_64(int64_t a1, int64_t a2, int64_t ar)
{
    if ((a1 > 0 && a2 > 0 && ar < 0) || (a1 < 0 && a2 < 0 && ar > 0)) {
        return 3; /* overflow */
    } else {
        if (ar < 0) {
            return 1;
        } else if (ar > 0) {
            return 2;
        } else {
            return 0;
        }
    }
}

static uint32_t cc_calc_addu_64(uint64_t a1, uint64_t a2, uint64_t ar)
{
    return (ar != 0) + 2 * (ar < a1);
}

static uint32_t cc_calc_addc_64(uint64_t a1, uint64_t a2, uint64_t ar)
{
    /* Recover a2 + carry_in.  */
    uint64_t a2c = ar - a1;
    /* Check for a2+carry_in overflow, then a1+a2c overflow.  */
    int carry_out = (a2c < a2) || (ar < a1);

    return (ar != 0) + 2 * carry_out;
}

static uint32_t cc_calc_sub_64(int64_t a1, int64_t a2, int64_t ar)
{
    if ((a1 > 0 && a2 < 0 && ar < 0) || (a1 < 0 && a2 > 0 && ar > 0)) {
        return 3; /* overflow */
    } else {
        if (ar < 0) {
            return 1;
        } else if (ar > 0) {
            return 2;
        } else {
            return 0;
        }
    }
}

static uint32_t cc_calc_subu_64(uint64_t a1, uint64_t a2, uint64_t ar)
{
    if (ar == 0) {
        return 2;
    } else {
        if (a2 > a1) {
            return 1;
        } else {
            return 3;
        }
    }
}

static uint32_t cc_calc_subb_64(uint64_t a1, uint64_t a2, uint64_t ar)
{
    int borrow_out;

    if (ar != a1 - a2) {	/* difference means borrow-in */
        borrow_out = (a2 >= a1);
    } else {
        borrow_out = (a2 > a1);
    }

    return (ar != 0) + 2 * !borrow_out;
}

static uint32_t cc_calc_abs_64(int64_t dst)
{
    if ((uint64_t)dst == 0x8000000000000000ULL) {
        return 3;
    } else if (dst) {
        return 1;
    } else {
        return 0;
    }
}

static uint32_t cc_calc_nabs_64(int64_t dst)
{
    return !!dst;
}

static uint32_t cc_calc_comp_64(int64_t dst)
{
    if ((uint64_t)dst == 0x8000000000000000ULL) {
        return 3;
    } else if (dst < 0) {
        return 1;
    } else if (dst > 0) {
        return 2;
    } else {
        return 0;
    }
}


static uint32_t cc_calc_add_32(int32_t a1, int32_t a2, int32_t ar)
{
    if ((a1 > 0 && a2 > 0 && ar < 0) || (a1 < 0 && a2 < 0 && ar > 0)) {
        return 3; /* overflow */
    } else {
        if (ar < 0) {
            return 1;
        } else if (ar > 0) {
            return 2;
        } else {
            return 0;
        }
    }
}

static uint32_t cc_calc_addu_32(uint32_t a1, uint32_t a2, uint32_t ar)
{
    return (ar != 0) + 2 * (ar < a1);
}

static uint32_t cc_calc_addc_32(uint32_t a1, uint32_t a2, uint32_t ar)
{
    /* Recover a2 + carry_in.  */
    uint32_t a2c = ar - a1;
    /* Check for a2+carry_in overflow, then a1+a2c overflow.  */
    int carry_out = (a2c < a2) || (ar < a1);

    return (ar != 0) + 2 * carry_out;
}

static uint32_t cc_calc_sub_32(int32_t a1, int32_t a2, int32_t ar)
{
    if ((a1 > 0 && a2 < 0 && ar < 0) || (a1 < 0 && a2 > 0 && ar > 0)) {
        return 3; /* overflow */
    } else {
        if (ar < 0) {
            return 1;
        } else if (ar > 0) {
            return 2;
        } else {
            return 0;
        }
    }
}

static uint32_t cc_calc_subu_32(uint32_t a1, uint32_t a2, uint32_t ar)
{
    if (ar == 0) {
        return 2;
    } else {
        if (a2 > a1) {
            return 1;
        } else {
            return 3;
        }
    }
}

static uint32_t cc_calc_subb_32(uint32_t a1, uint32_t a2, uint32_t ar)
{
    int borrow_out;

    if (ar != a1 - a2) {	/* difference means borrow-in */
        borrow_out = (a2 >= a1);
    } else {
        borrow_out = (a2 > a1);
    }

    return (ar != 0) + 2 * !borrow_out;
}

static uint32_t cc_calc_abs_32(int32_t dst)
{
    if ((uint32_t)dst == 0x80000000UL) {
        return 3;
    } else if (dst) {
        return 1;
    } else {
        return 0;
    }
}

static uint32_t cc_calc_nabs_32(int32_t dst)
{
    return !!dst;
}

static uint32_t cc_calc_comp_32(int32_t dst)
{
    if ((uint32_t)dst == 0x80000000UL) {
        return 3;
    } else if (dst < 0) {
        return 1;
    } else if (dst > 0) {
        return 2;
    } else {
        return 0;
    }
}

/* calculate condition code for insert character under mask insn */
static uint32_t cc_calc_icm(uint64_t mask, uint64_t val)
{
    if ((val & mask) == 0) {
        return 0;
    } else {
        int top = clz64(mask);
        if ((int64_t)(val << top) < 0) {
            return 1;
        } else {
            return 2;
        }
    }
}

static uint32_t cc_calc_sla_32(uint32_t src, int shift)
{
    uint32_t mask = ((1U << shift) - 1U) << (32 - shift);
    uint32_t sign = 1U << 31;
    uint32_t match;
    int32_t r;

    /* Check if the sign bit stays the same.  */
    if (src & sign) {
        match = mask;
    } else {
        match = 0;
    }
    if ((src & mask) != match) {
        /* Overflow.  */
        return 3;
    }

    r = ((src << shift) & ~sign) | (src & sign);
    if (r == 0) {
        return 0;
    } else if (r < 0) {
        return 1;
    }
    return 2;
}

static uint32_t cc_calc_sla_64(uint64_t src, int shift)
{
    uint64_t mask = ((1ULL << shift) - 1ULL) << (64 - shift);
    uint64_t sign = 1ULL << 63;
    uint64_t match;
    int64_t r;

    /* Check if the sign bit stays the same.  */
    if (src & sign) {
        match = mask;
    } else {
        match = 0;
    }
    if ((src & mask) != match) {
        /* Overflow.  */
        return 3;
    }

    r = ((src << shift) & ~sign) | (src & sign);
    if (r == 0) {
        return 0;
    } else if (r < 0) {
        return 1;
    }
    return 2;
}

static uint32_t cc_calc_flogr(uint64_t dst)
{
    return dst ? 2 : 0;
}

static uint32_t do_calc_cc(CPUS390XState *env, uint32_t cc_op,
                                  uint64_t src, uint64_t dst, uint64_t vr)
{
    S390CPU *cpu = s390_env_get_cpu(env);
    uint32_t r = 0;

    switch (cc_op) {
    case CC_OP_CONST0:
    case CC_OP_CONST1:
    case CC_OP_CONST2:
    case CC_OP_CONST3:
        /* cc_op value _is_ cc */
        r = cc_op;
        break;
    case CC_OP_LTGT0_32:
        r = cc_calc_ltgt0_32(dst);
        break;
    case CC_OP_LTGT0_64:
        r =  cc_calc_ltgt0_64(dst);
        break;
    case CC_OP_LTGT_32:
        r =  cc_calc_ltgt_32(src, dst);
        break;
    case CC_OP_LTGT_64:
        r =  cc_calc_ltgt_64(src, dst);
        break;
    case CC_OP_LTUGTU_32:
        r =  cc_calc_ltugtu_32(src, dst);
        break;
    case CC_OP_LTUGTU_64:
        r =  cc_calc_ltugtu_64(src, dst);
        break;
    case CC_OP_TM_32:
        r =  cc_calc_tm_32(src, dst);
        break;
    case CC_OP_TM_64:
        r =  cc_calc_tm_64(src, dst);
        break;
    case CC_OP_NZ:
        r =  cc_calc_nz(dst);
        break;
    case CC_OP_ADD_64:
        r =  cc_calc_add_64(src, dst, vr);
        break;
    case CC_OP_ADDU_64:
        r =  cc_calc_addu_64(src, dst, vr);
        break;
    case CC_OP_ADDC_64:
        r =  cc_calc_addc_64(src, dst, vr);
        break;
    case CC_OP_SUB_64:
        r =  cc_calc_sub_64(src, dst, vr);
        break;
    case CC_OP_SUBU_64:
        r =  cc_calc_subu_64(src, dst, vr);
        break;
    case CC_OP_SUBB_64:
        r =  cc_calc_subb_64(src, dst, vr);
        break;
    case CC_OP_ABS_64:
        r =  cc_calc_abs_64(dst);
        break;
    case CC_OP_NABS_64:
        r =  cc_calc_nabs_64(dst);
        break;
    case CC_OP_COMP_64:
        r =  cc_calc_comp_64(dst);
        break;

    case CC_OP_ADD_32:
        r =  cc_calc_add_32(src, dst, vr);
        break;
    case CC_OP_ADDU_32:
        r =  cc_calc_addu_32(src, dst, vr);
        break;
    case CC_OP_ADDC_32:
        r =  cc_calc_addc_32(src, dst, vr);
        break;
    case CC_OP_SUB_32:
        r =  cc_calc_sub_32(src, dst, vr);
        break;
    case CC_OP_SUBU_32:
        r =  cc_calc_subu_32(src, dst, vr);
        break;
    case CC_OP_SUBB_32:
        r =  cc_calc_subb_32(src, dst, vr);
        break;
    case CC_OP_ABS_32:
        r =  cc_calc_abs_32(dst);
        break;
    case CC_OP_NABS_32:
        r =  cc_calc_nabs_32(dst);
        break;
    case CC_OP_COMP_32:
        r =  cc_calc_comp_32(dst);
        break;

    case CC_OP_ICM:
        r =  cc_calc_icm(src, dst);
        break;
    case CC_OP_SLA_32:
        r =  cc_calc_sla_32(src, dst);
        break;
    case CC_OP_SLA_64:
        r =  cc_calc_sla_64(src, dst);
        break;
    case CC_OP_FLOGR:
        r = cc_calc_flogr(dst);
        break;

    case CC_OP_NZ_F32:
        r = set_cc_nz_f32(dst);
        break;
    case CC_OP_NZ_F64:
        r = set_cc_nz_f64(dst);
        break;
    case CC_OP_NZ_F128:
        r = set_cc_nz_f128(make_float128(src, dst));
        break;

    default:
        cpu_abort(CPU(cpu), "Unknown CC operation: %s\n", cc_name(cc_op));
    }

    HELPER_LOG("%s: %15s 0x%016lx 0x%016lx 0x%016lx = %d\n", __func__,
               cc_name(cc_op), src, dst, vr, r);
    return r;
}

uint32_t calc_cc(CPUS390XState *env, uint32_t cc_op, uint64_t src, uint64_t dst,
                 uint64_t vr)
{
    return do_calc_cc(env, cc_op, src, dst, vr);
}

uint32_t HELPER(calc_cc)(CPUS390XState *env, uint32_t cc_op, uint64_t src,
                         uint64_t dst, uint64_t vr)
{
    return do_calc_cc(env, cc_op, src, dst, vr);
}

#ifndef CONFIG_USER_ONLY
void HELPER(load_psw)(CPUS390XState *env, uint64_t mask, uint64_t addr)
{
    load_psw(env, mask, addr);
    cpu_loop_exit(CPU(s390_env_get_cpu(env)));
}

void HELPER(sacf)(CPUS390XState *env, uint64_t a1)
{
    HELPER_LOG("%s: %16" PRIx64 "\n", __func__, a1);

    switch (a1 & 0xf00) {
    case 0x000:
        env->psw.mask &= ~PSW_MASK_ASC;
        env->psw.mask |= PSW_ASC_PRIMARY;
        break;
    case 0x100:
        env->psw.mask &= ~PSW_MASK_ASC;
        env->psw.mask |= PSW_ASC_SECONDARY;
        break;
    case 0x300:
        env->psw.mask &= ~PSW_MASK_ASC;
        env->psw.mask |= PSW_ASC_HOME;
        break;
    default:
        qemu_log("unknown sacf mode: %" PRIx64 "\n", a1);
        program_interrupt(env, PGM_SPECIFICATION, 2);
        break;
    }
}
#endif
Commit	Line	Data
a78b0504 BS	1	/*
	2	* S/390 condition code helper routines
	3	*
	4	* Copyright (c) 2009 Ulrich Hecht
	5	* Copyright (c) 2009 Alexander Graf
	6	*
	7	* This library is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU Lesser General Public
	9	* License as published by the Free Software Foundation; either
	10	* version 2 of the License, or (at your option) any later version.
	11	*
	12	* This library is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	15	* Lesser General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU Lesser General Public
	18	* License along with this library; if not, see <http://www.gnu.org/licenses/>.
	19	*/
	20
	21	#include "cpu.h"
2ef6175a	22	#include "exec/helper-proto.h"
00d2dc19	23	#include "qemu/host-utils.h"
a78b0504 BS	24
	25	/* #define DEBUG_HELPER */
	26	#ifdef DEBUG_HELPER
	27	#define HELPER_LOG(x...) qemu_log(x)
	28	#else
	29	#define HELPER_LOG(x...)
	30	#endif
	31
443aaeb8	32	static uint32_t cc_calc_ltgt_32(int32_t src, int32_t dst)
a78b0504 BS	33	{
	34	if (src == dst) {
	35	return 0;
	36	} else if (src < dst) {
	37	return 1;
	38	} else {
	39	return 2;
	40	}
	41	}
	42
443aaeb8	43	static uint32_t cc_calc_ltgt0_32(int32_t dst)
a78b0504	44	{
443aaeb8	45	return cc_calc_ltgt_32(dst, 0);
a78b0504 BS	46	}
a78b0504 BS	47
443aaeb8	48	static uint32_t cc_calc_ltgt_64(int64_t src, int64_t dst)
a78b0504 BS	49	{
	50	if (src == dst) {
	51	return 0;
	52	} else if (src < dst) {
	53	return 1;
	54	} else {
	55	return 2;
	56	}
	57	}
	58
443aaeb8	59	static uint32_t cc_calc_ltgt0_64(int64_t dst)
a78b0504	60	{
443aaeb8	61	return cc_calc_ltgt_64(dst, 0);
a78b0504 BS	62	}
a78b0504 BS	63
443aaeb8	64	static uint32_t cc_calc_ltugtu_32(uint32_t src, uint32_t dst)
a78b0504 BS	65	{
	66	if (src == dst) {
	67	return 0;
	68	} else if (src < dst) {
	69	return 1;
	70	} else {
	71	return 2;
	72	}
	73	}
	74
443aaeb8	75	static uint32_t cc_calc_ltugtu_64(uint64_t src, uint64_t dst)
a78b0504 BS	76	{
	77	if (src == dst) {
	78	return 0;
	79	} else if (src < dst) {
	80	return 1;
	81	} else {
	82	return 2;
	83	}
	84	}
	85
443aaeb8	86	static uint32_t cc_calc_tm_32(uint32_t val, uint32_t mask)
a78b0504	87	{
00d2dc19	88	uint32_t r = val & mask;
a78b0504	89
00d2dc19	90	if (r == 0) {
a78b0504 BS	91	return 0;
	92	} else if (r == mask) {
	93	return 3;
	94	} else {
	95	return 1;
	96	}
	97	}
	98
443aaeb8	99	static uint32_t cc_calc_tm_64(uint64_t val, uint64_t mask)
a78b0504	100	{
00d2dc19	101	uint64_t r = val & mask;
a78b0504	102
00d2dc19	103	if (r == 0) {
a78b0504 BS	104	return 0;
	105	} else if (r == mask) {
	106	return 3;
	107	} else {
00d2dc19 RH	108	int top = clz64(mask);
00d2dc19 RH	109	if ((int64_t)(val << top) < 0) {
a78b0504 BS	110	return 2;
	111	} else {
	112	return 1;
	113	}
	114	}
	115	}
	116
443aaeb8	117	static uint32_t cc_calc_nz(uint64_t dst)
a78b0504 BS	118	{
	119	return !!dst;
	120	}
	121
443aaeb8	122	static uint32_t cc_calc_add_64(int64_t a1, int64_t a2, int64_t ar)
a78b0504 BS	123	{
	124	if ((a1 > 0 && a2 > 0 && ar < 0) \|\| (a1 < 0 && a2 < 0 && ar > 0)) {
	125	return 3; /* overflow */
	126	} else {
	127	if (ar < 0) {
	128	return 1;
	129	} else if (ar > 0) {
	130	return 2;
	131	} else {
	132	return 0;
	133	}
	134	}
	135	}
	136
443aaeb8	137	static uint32_t cc_calc_addu_64(uint64_t a1, uint64_t a2, uint64_t ar)
a78b0504	138	{
4e4bb438 RH	139	return (ar != 0) + 2 * (ar < a1);
	140	}
	141
443aaeb8	142	static uint32_t cc_calc_addc_64(uint64_t a1, uint64_t a2, uint64_t ar)
4e4bb438 RH	143	{
	144	/* Recover a2 + carry_in. */
	145	uint64_t a2c = ar - a1;
	146	/* Check for a2+carry_in overflow, then a1+a2c overflow. */
	147	int carry_out = (a2c < a2) \|\| (ar < a1);
	148
	149	return (ar != 0) + 2 * carry_out;
a78b0504 BS	150	}
a78b0504 BS	151
443aaeb8	152	static uint32_t cc_calc_sub_64(int64_t a1, int64_t a2, int64_t ar)
a78b0504 BS	153	{
	154	if ((a1 > 0 && a2 < 0 && ar < 0) \|\| (a1 < 0 && a2 > 0 && ar > 0)) {
	155	return 3; /* overflow */
	156	} else {
	157	if (ar < 0) {
	158	return 1;
	159	} else if (ar > 0) {
	160	return 2;
	161	} else {
	162	return 0;
	163	}
	164	}
	165	}
	166
443aaeb8	167	static uint32_t cc_calc_subu_64(uint64_t a1, uint64_t a2, uint64_t ar)
a78b0504 BS	168	{
	169	if (ar == 0) {
	170	return 2;
	171	} else {
	172	if (a2 > a1) {
	173	return 1;
	174	} else {
	175	return 3;
	176	}
	177	}
	178	}
	179
443aaeb8	180	static uint32_t cc_calc_subb_64(uint64_t a1, uint64_t a2, uint64_t ar)
4e4bb438	181	{
4e4bb438 RH	182	int borrow_out;
4e4bb438 RH	183
9ef14736 TG	184	if (ar != a1 - a2) { /* difference means borrow-in */
9ef14736 TG	185	borrow_out = (a2 >= a1);
4e4bb438	186	} else {
4e4bb438 RH	187	borrow_out = (a2 > a1);
	188	}
	189
	190	return (ar != 0) + 2 * !borrow_out;
	191	}
	192
443aaeb8	193	static uint32_t cc_calc_abs_64(int64_t dst)
a78b0504 BS	194	{
	195	if ((uint64_t)dst == 0x8000000000000000ULL) {
	196	return 3;
	197	} else if (dst) {
	198	return 1;
	199	} else {
	200	return 0;
	201	}
	202	}
	203
443aaeb8	204	static uint32_t cc_calc_nabs_64(int64_t dst)
a78b0504 BS	205	{
	206	return !!dst;
	207	}
	208
443aaeb8	209	static uint32_t cc_calc_comp_64(int64_t dst)
a78b0504 BS	210	{
	211	if ((uint64_t)dst == 0x8000000000000000ULL) {
	212	return 3;
	213	} else if (dst < 0) {
	214	return 1;
	215	} else if (dst > 0) {
	216	return 2;
	217	} else {
	218	return 0;
	219	}
	220	}
	221
	222
443aaeb8	223	static uint32_t cc_calc_add_32(int32_t a1, int32_t a2, int32_t ar)
a78b0504 BS	224	{
	225	if ((a1 > 0 && a2 > 0 && ar < 0) \|\| (a1 < 0 && a2 < 0 && ar > 0)) {
	226	return 3; /* overflow */
	227	} else {
	228	if (ar < 0) {
	229	return 1;
	230	} else if (ar > 0) {
	231	return 2;
	232	} else {
	233	return 0;
	234	}
	235	}
	236	}
	237
443aaeb8	238	static uint32_t cc_calc_addu_32(uint32_t a1, uint32_t a2, uint32_t ar)
a78b0504	239	{
4e4bb438 RH	240	return (ar != 0) + 2 * (ar < a1);
	241	}
	242
443aaeb8	243	static uint32_t cc_calc_addc_32(uint32_t a1, uint32_t a2, uint32_t ar)
4e4bb438 RH	244	{
	245	/* Recover a2 + carry_in. */
	246	uint32_t a2c = ar - a1;
	247	/* Check for a2+carry_in overflow, then a1+a2c overflow. */
	248	int carry_out = (a2c < a2) \|\| (ar < a1);
	249
	250	return (ar != 0) + 2 * carry_out;
a78b0504 BS	251	}
a78b0504 BS	252
443aaeb8	253	static uint32_t cc_calc_sub_32(int32_t a1, int32_t a2, int32_t ar)
a78b0504 BS	254	{
	255	if ((a1 > 0 && a2 < 0 && ar < 0) \|\| (a1 < 0 && a2 > 0 && ar > 0)) {
	256	return 3; /* overflow */
	257	} else {
	258	if (ar < 0) {
	259	return 1;
	260	} else if (ar > 0) {
	261	return 2;
	262	} else {
	263	return 0;
	264	}
	265	}
	266	}
	267
443aaeb8	268	static uint32_t cc_calc_subu_32(uint32_t a1, uint32_t a2, uint32_t ar)
a78b0504 BS	269	{
	270	if (ar == 0) {
	271	return 2;
	272	} else {
	273	if (a2 > a1) {
	274	return 1;
	275	} else {
	276	return 3;
	277	}
	278	}
	279	}
	280
443aaeb8	281	static uint32_t cc_calc_subb_32(uint32_t a1, uint32_t a2, uint32_t ar)
4e4bb438	282	{
4e4bb438 RH	283	int borrow_out;
4e4bb438 RH	284
9ef14736 TG	285	if (ar != a1 - a2) { /* difference means borrow-in */
9ef14736 TG	286	borrow_out = (a2 >= a1);
4e4bb438	287	} else {
4e4bb438 RH	288	borrow_out = (a2 > a1);
	289	}
	290
	291	return (ar != 0) + 2 * !borrow_out;
	292	}
	293
443aaeb8	294	static uint32_t cc_calc_abs_32(int32_t dst)
a78b0504 BS	295	{
	296	if ((uint32_t)dst == 0x80000000UL) {
	297	return 3;
	298	} else if (dst) {
	299	return 1;
	300	} else {
	301	return 0;
	302	}
	303	}
	304
443aaeb8	305	static uint32_t cc_calc_nabs_32(int32_t dst)
a78b0504 BS	306	{
	307	return !!dst;
	308	}
	309
443aaeb8	310	static uint32_t cc_calc_comp_32(int32_t dst)
a78b0504 BS	311	{
	312	if ((uint32_t)dst == 0x80000000UL) {
	313	return 3;
	314	} else if (dst < 0) {
	315	return 1;
	316	} else if (dst > 0) {
	317	return 2;
	318	} else {
	319	return 0;
	320	}
	321	}
	322
	323	/* calculate condition code for insert character under mask insn */
58a9e35b	324	static uint32_t cc_calc_icm(uint64_t mask, uint64_t val)
a78b0504	325	{
58a9e35b RH	326	if ((val & mask) == 0) {
	327	return 0;
	328	} else {
	329	int top = clz64(mask);
	330	if ((int64_t)(val << top) < 0) {
a78b0504 BS	331	return 1;
	332	} else {
	333	return 2;
	334	}
	335	}
a78b0504 BS	336	}
a78b0504 BS	337
cbe24bfa	338	static uint32_t cc_calc_sla_32(uint32_t src, int shift)
a78b0504	339	{
cbe24bfa RH	340	uint32_t mask = ((1U << shift) - 1U) << (32 - shift);
	341	uint32_t sign = 1U << 31;
	342	uint32_t match;
	343	int32_t r;
a78b0504	344
cbe24bfa RH	345	/* Check if the sign bit stays the same. */
cbe24bfa RH	346	if (src & sign) {
a78b0504 BS	347	match = mask;
	348	} else {
	349	match = 0;
	350	}
a78b0504	351	if ((src & mask) != match) {
cbe24bfa	352	/* Overflow. */
a78b0504 BS	353	return 3;
	354	}
	355
cbe24bfa RH	356	r = ((src << shift) & ~sign) \| (src & sign);
cbe24bfa RH	357	if (r == 0) {
a78b0504	358	return 0;
cbe24bfa	359	} else if (r < 0) {
a78b0504 BS	360	return 1;
a78b0504 BS	361	}
a78b0504 BS	362	return 2;
	363	}
	364
cbe24bfa RH	365	static uint32_t cc_calc_sla_64(uint64_t src, int shift)
	366	{
	367	uint64_t mask = ((1ULL << shift) - 1ULL) << (64 - shift);
	368	uint64_t sign = 1ULL << 63;
	369	uint64_t match;
	370	int64_t r;
	371
	372	/* Check if the sign bit stays the same. */
	373	if (src & sign) {
	374	match = mask;
	375	} else {
	376	match = 0;
	377	}
	378	if ((src & mask) != match) {
	379	/* Overflow. */
	380	return 3;
	381	}
	382
	383	r = ((src << shift) & ~sign) \| (src & sign);
	384	if (r == 0) {
	385	return 0;
	386	} else if (r < 0) {
	387	return 1;
	388	}
	389	return 2;
	390	}
a78b0504	391
102bf2c6 RH	392	static uint32_t cc_calc_flogr(uint64_t dst)
	393	{
	394	return dst ? 2 : 0;
	395	}
	396
443aaeb8	397	static uint32_t do_calc_cc(CPUS390XState *env, uint32_t cc_op,
a78b0504 BS	398	uint64_t src, uint64_t dst, uint64_t vr)
a78b0504 BS	399	{
a47dddd7	400	S390CPU *cpu = s390_env_get_cpu(env);
a78b0504 BS	401	uint32_t r = 0;
	402
	403	switch (cc_op) {
	404	case CC_OP_CONST0:
	405	case CC_OP_CONST1:
	406	case CC_OP_CONST2:
	407	case CC_OP_CONST3:
	408	/* cc_op value _is_ cc */
	409	r = cc_op;
	410	break;
	411	case CC_OP_LTGT0_32:
443aaeb8	412	r = cc_calc_ltgt0_32(dst);
a78b0504 BS	413	break;
a78b0504 BS	414	case CC_OP_LTGT0_64:
443aaeb8	415	r = cc_calc_ltgt0_64(dst);
a78b0504 BS	416	break;
a78b0504 BS	417	case CC_OP_LTGT_32:
443aaeb8	418	r = cc_calc_ltgt_32(src, dst);
a78b0504 BS	419	break;
a78b0504 BS	420	case CC_OP_LTGT_64:
443aaeb8	421	r = cc_calc_ltgt_64(src, dst);
a78b0504 BS	422	break;
a78b0504 BS	423	case CC_OP_LTUGTU_32:
443aaeb8	424	r = cc_calc_ltugtu_32(src, dst);
a78b0504 BS	425	break;
a78b0504 BS	426	case CC_OP_LTUGTU_64:
443aaeb8	427	r = cc_calc_ltugtu_64(src, dst);
a78b0504 BS	428	break;
a78b0504 BS	429	case CC_OP_TM_32:
443aaeb8	430	r = cc_calc_tm_32(src, dst);
a78b0504 BS	431	break;
a78b0504 BS	432	case CC_OP_TM_64:
443aaeb8	433	r = cc_calc_tm_64(src, dst);
a78b0504 BS	434	break;
a78b0504 BS	435	case CC_OP_NZ:
443aaeb8	436	r = cc_calc_nz(dst);
a78b0504 BS	437	break;
a78b0504 BS	438	case CC_OP_ADD_64:
443aaeb8	439	r = cc_calc_add_64(src, dst, vr);
a78b0504 BS	440	break;
a78b0504 BS	441	case CC_OP_ADDU_64:
443aaeb8	442	r = cc_calc_addu_64(src, dst, vr);
a78b0504	443	break;
4e4bb438	444	case CC_OP_ADDC_64:
443aaeb8	445	r = cc_calc_addc_64(src, dst, vr);
4e4bb438	446	break;
a78b0504	447	case CC_OP_SUB_64:
443aaeb8	448	r = cc_calc_sub_64(src, dst, vr);
a78b0504 BS	449	break;
a78b0504 BS	450	case CC_OP_SUBU_64:
443aaeb8	451	r = cc_calc_subu_64(src, dst, vr);
a78b0504	452	break;
4e4bb438	453	case CC_OP_SUBB_64:
443aaeb8	454	r = cc_calc_subb_64(src, dst, vr);
4e4bb438	455	break;
a78b0504	456	case CC_OP_ABS_64:
443aaeb8	457	r = cc_calc_abs_64(dst);
a78b0504 BS	458	break;
a78b0504 BS	459	case CC_OP_NABS_64:
443aaeb8	460	r = cc_calc_nabs_64(dst);
a78b0504 BS	461	break;
a78b0504 BS	462	case CC_OP_COMP_64:
443aaeb8	463	r = cc_calc_comp_64(dst);
a78b0504 BS	464	break;
	465
	466	case CC_OP_ADD_32:
443aaeb8	467	r = cc_calc_add_32(src, dst, vr);
a78b0504 BS	468	break;
a78b0504 BS	469	case CC_OP_ADDU_32:
443aaeb8	470	r = cc_calc_addu_32(src, dst, vr);
a78b0504	471	break;
4e4bb438	472	case CC_OP_ADDC_32:
443aaeb8	473	r = cc_calc_addc_32(src, dst, vr);
4e4bb438	474	break;
a78b0504	475	case CC_OP_SUB_32:
443aaeb8	476	r = cc_calc_sub_32(src, dst, vr);
a78b0504 BS	477	break;
a78b0504 BS	478	case CC_OP_SUBU_32:
443aaeb8	479	r = cc_calc_subu_32(src, dst, vr);
a78b0504	480	break;
4e4bb438	481	case CC_OP_SUBB_32:
443aaeb8	482	r = cc_calc_subb_32(src, dst, vr);
4e4bb438	483	break;
a78b0504	484	case CC_OP_ABS_32:
443aaeb8	485	r = cc_calc_abs_32(dst);
a78b0504 BS	486	break;
a78b0504 BS	487	case CC_OP_NABS_32:
443aaeb8	488	r = cc_calc_nabs_32(dst);
a78b0504 BS	489	break;
a78b0504 BS	490	case CC_OP_COMP_32:
443aaeb8	491	r = cc_calc_comp_32(dst);
a78b0504 BS	492	break;
	493
	494	case CC_OP_ICM:
58a9e35b	495	r = cc_calc_icm(src, dst);
a78b0504	496	break;
cbe24bfa RH	497	case CC_OP_SLA_32:
	498	r = cc_calc_sla_32(src, dst);
	499	break;
	500	case CC_OP_SLA_64:
	501	r = cc_calc_sla_64(src, dst);
a78b0504	502	break;
102bf2c6 RH	503	case CC_OP_FLOGR:
	504	r = cc_calc_flogr(dst);
	505	break;
a78b0504	506
a78b0504 BS	507	case CC_OP_NZ_F32:
	508	r = set_cc_nz_f32(dst);
	509	break;
	510	case CC_OP_NZ_F64:
	511	r = set_cc_nz_f64(dst);
	512	break;
587626f8 RH	513	case CC_OP_NZ_F128:
	514	r = set_cc_nz_f128(make_float128(src, dst));
	515	break;
a78b0504 BS	516
a78b0504 BS	517	default:
a47dddd7	518	cpu_abort(CPU(cpu), "Unknown CC operation: %s\n", cc_name(cc_op));
a78b0504 BS	519	}
	520
	521	HELPER_LOG("%s: %15s 0x%016lx 0x%016lx 0x%016lx = %d\n", __func__,
	522	cc_name(cc_op), src, dst, vr, r);
	523	return r;
	524	}
	525
	526	uint32_t calc_cc(CPUS390XState *env, uint32_t cc_op, uint64_t src, uint64_t dst,
	527	uint64_t vr)
	528	{
	529	return do_calc_cc(env, cc_op, src, dst, vr);
	530	}
	531
932385a3 BS	532	uint32_t HELPER(calc_cc)(CPUS390XState *env, uint32_t cc_op, uint64_t src,
932385a3 BS	533	uint64_t dst, uint64_t vr)
a78b0504 BS	534	{
	535	return do_calc_cc(env, cc_op, src, dst, vr);
	536	}
	537
a78b0504	538	#ifndef CONFIG_USER_ONLY
932385a3	539	void HELPER(load_psw)(CPUS390XState *env, uint64_t mask, uint64_t addr)
a78b0504 BS	540	{
a78b0504 BS	541	load_psw(env, mask, addr);
5638d180	542	cpu_loop_exit(CPU(s390_env_get_cpu(env)));
a78b0504 BS	543	}
a78b0504 BS	544
932385a3	545	void HELPER(sacf)(CPUS390XState *env, uint64_t a1)
a78b0504 BS	546	{
	547	HELPER_LOG("%s: %16" PRIx64 "\n", __func__, a1);
	548
	549	switch (a1 & 0xf00) {
	550	case 0x000:
	551	env->psw.mask &= ~PSW_MASK_ASC;
	552	env->psw.mask \|= PSW_ASC_PRIMARY;
	553	break;
	554	case 0x100:
	555	env->psw.mask &= ~PSW_MASK_ASC;
	556	env->psw.mask \|= PSW_ASC_SECONDARY;
	557	break;
	558	case 0x300:
	559	env->psw.mask &= ~PSW_MASK_ASC;
	560	env->psw.mask \|= PSW_ASC_HOME;
	561	break;
	562	default:
	563	qemu_log("unknown sacf mode: %" PRIx64 "\n", a1);
	564	program_interrupt(env, PGM_SPECIFICATION, 2);
	565	break;
	566	}
	567	}
	568	#endif