xref: /qemu/target/s390x/tcg/misc_helper.c (revision e6a80232f4087e8c7ec253f573319f69165b859d)
110ec5117SAlexander Graf /*
2aea1e885SBlue Swirl  *  S/390 misc helper routines
310ec5117SAlexander Graf  *
4defb0e31SAlexander Graf  *  Copyright (c) 2009 Ulrich Hecht
510ec5117SAlexander Graf  *  Copyright (c) 2009 Alexander Graf
610ec5117SAlexander Graf  *
710ec5117SAlexander Graf  * This library is free software; you can redistribute it and/or
810ec5117SAlexander Graf  * modify it under the terms of the GNU Lesser General Public
910ec5117SAlexander Graf  * License as published by the Free Software Foundation; either
1041c6a6ddSThomas Huth  * version 2.1 of the License, or (at your option) any later version.
1110ec5117SAlexander Graf  *
1210ec5117SAlexander Graf  * This library is distributed in the hope that it will be useful,
1310ec5117SAlexander Graf  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1410ec5117SAlexander Graf  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
1510ec5117SAlexander Graf  * Lesser General Public License for more details.
1610ec5117SAlexander Graf  *
1710ec5117SAlexander Graf  * You should have received a copy of the GNU Lesser General Public
1870539e18SBlue Swirl  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
1910ec5117SAlexander Graf  */
2010ec5117SAlexander Graf 
219615495aSPeter Maydell #include "qemu/osdep.h"
22*e6a80232SMiroslav Rezanina #include "qemu/cutils.h"
23278f5e98SAlex Bennée #include "qemu/main-loop.h"
243e457172SBlue Swirl #include "cpu.h"
254e58b838SDavid Hildenbrand #include "internal.h"
26022c62cbSPaolo Bonzini #include "exec/memory.h"
271de7afc9SPaolo Bonzini #include "qemu/host-utils.h"
282ef6175aSRichard Henderson #include "exec/helper-proto.h"
291de7afc9SPaolo Bonzini #include "qemu/timer.h"
3063c91552SPaolo Bonzini #include "exec/exec-all.h"
31f08b6170SPaolo Bonzini #include "exec/cpu_ldst.h"
327de3b1cdSDavid Hildenbrand #include "qapi/error.h"
337de3b1cdSDavid Hildenbrand #include "tcg_s390x.h"
34965018beSRichard Henderson #include "s390-tod.h"
3510ec5117SAlexander Graf 
361864b94aSAlexander Graf #if !defined(CONFIG_USER_ONLY)
37f0778475SChristian Borntraeger #include "sysemu/cpus.h"
389c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
3940fa5264SHeinz Graalfs #include "hw/s390x/ebcdic.h"
402c98a6c1SDavid Hildenbrand #include "hw/s390x/s390-virtio-hcall.h"
4153d8e91dSDavid Hildenbrand #include "hw/s390x/sclp.h"
426a253de3SDavid Hildenbrand #include "hw/s390x/s390_flic.h"
4379947862SDavid Hildenbrand #include "hw/s390x/ioinst.h"
44f6c232ceSCornelia Huck #include "hw/s390x/s390-pci-inst.h"
4579947862SDavid Hildenbrand #include "hw/boards.h"
467de3b1cdSDavid Hildenbrand #include "hw/s390x/tod.h"
4710ec5117SAlexander Graf #endif
48d5a43964SAlexander Graf 
49defb0e31SAlexander Graf /* #define DEBUG_HELPER */
50defb0e31SAlexander Graf #ifdef DEBUG_HELPER
51defb0e31SAlexander Graf #define HELPER_LOG(x...) qemu_log(x)
52defb0e31SAlexander Graf #else
53defb0e31SAlexander Graf #define HELPER_LOG(x...)
54defb0e31SAlexander Graf #endif
55defb0e31SAlexander Graf 
56d5a103cdSRichard Henderson /* Raise an exception statically from a TB.  */
57089f5c06SBlue Swirl void HELPER(exception)(CPUS390XState *env, uint32_t excp)
58defb0e31SAlexander Graf {
59dc79e928SRichard Henderson     CPUState *cs = env_cpu(env);
6027103424SAndreas Färber 
6171e47088SBlue Swirl     HELPER_LOG("%s: exception %d\n", __func__, excp);
6227103424SAndreas Färber     cs->exception_index = excp;
635638d180SAndreas Färber     cpu_loop_exit(cs);
64defb0e31SAlexander Graf }
65defb0e31SAlexander Graf 
664bac52f5SDavid Hildenbrand /* Store CPU Timer (also used for EXTRACT CPU TIME) */
674bac52f5SDavid Hildenbrand uint64_t HELPER(stpt)(CPUS390XState *env)
684bac52f5SDavid Hildenbrand {
694bac52f5SDavid Hildenbrand #if defined(CONFIG_USER_ONLY)
704bac52f5SDavid Hildenbrand     /*
714bac52f5SDavid Hildenbrand      * Fake a descending CPU timer. We could get negative values here,
724bac52f5SDavid Hildenbrand      * but we don't care as it is up to the OS when to process that
734bac52f5SDavid Hildenbrand      * interrupt and reset to > 0.
744bac52f5SDavid Hildenbrand      */
754bac52f5SDavid Hildenbrand     return UINT64_MAX - (uint64_t)cpu_get_host_ticks();
764bac52f5SDavid Hildenbrand #else
774bac52f5SDavid Hildenbrand     return time2tod(env->cputm - qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
784bac52f5SDavid Hildenbrand #endif
794bac52f5SDavid Hildenbrand }
804bac52f5SDavid Hildenbrand 
81965018beSRichard Henderson /* Store Clock */
82965018beSRichard Henderson uint64_t HELPER(stck)(CPUS390XState *env)
83965018beSRichard Henderson {
84965018beSRichard Henderson #ifdef CONFIG_USER_ONLY
85965018beSRichard Henderson     struct timespec ts;
86965018beSRichard Henderson     uint64_t ns;
8731006af3SAurelien Jarno 
88965018beSRichard Henderson     clock_gettime(CLOCK_REALTIME, &ts);
89965018beSRichard Henderson     ns = ts.tv_sec * NANOSECONDS_PER_SECOND + ts.tv_nsec;
90965018beSRichard Henderson 
91965018beSRichard Henderson     return TOD_UNIX_EPOCH + time2tod(ns);
92965018beSRichard Henderson #else
93965018beSRichard Henderson     S390TODState *td = s390_get_todstate();
94965018beSRichard Henderson     S390TODClass *tdc = S390_TOD_GET_CLASS(td);
95965018beSRichard Henderson     S390TOD tod;
96965018beSRichard Henderson 
97965018beSRichard Henderson     tdc->get(td, &tod, &error_abort);
98965018beSRichard Henderson     return tod.low;
99965018beSRichard Henderson #endif
100965018beSRichard Henderson }
101965018beSRichard Henderson 
102965018beSRichard Henderson #ifndef CONFIG_USER_ONLY
103defb0e31SAlexander Graf /* SCLP service call */
104dc458df9SRichard Henderson uint32_t HELPER(servc)(CPUS390XState *env, uint64_t r1, uint64_t r2)
105defb0e31SAlexander Graf {
1068d04fb55SJan Kiszka     qemu_mutex_lock_iothread();
1076e252802SThomas Huth     int r = sclp_service_call(env, r1, r2);
1088d04fb55SJan Kiszka     qemu_mutex_unlock_iothread();
1091a38921aSDavid Hildenbrand     if (r < 0) {
1101e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, -r, GETPC());
1111a38921aSDavid Hildenbrand     }
1129abf567dSChristian Borntraeger     return r;
1139abf567dSChristian Borntraeger }
114defb0e31SAlexander Graf 
1158df7eef3SAurelien Jarno void HELPER(diag)(CPUS390XState *env, uint32_t r1, uint32_t r3, uint32_t num)
116defb0e31SAlexander Graf {
117defb0e31SAlexander Graf     uint64_t r;
118defb0e31SAlexander Graf 
119defb0e31SAlexander Graf     switch (num) {
120defb0e31SAlexander Graf     case 0x500:
121defb0e31SAlexander Graf         /* KVM hypercall */
1222cf9953bSAurelien Jarno         qemu_mutex_lock_iothread();
12328e942f8SCornelia Huck         r = s390_virtio_hypercall(env);
1242cf9953bSAurelien Jarno         qemu_mutex_unlock_iothread();
125defb0e31SAlexander Graf         break;
126defb0e31SAlexander Graf     case 0x44:
127defb0e31SAlexander Graf         /* yield */
128defb0e31SAlexander Graf         r = 0;
129defb0e31SAlexander Graf         break;
130defb0e31SAlexander Graf     case 0x308:
131defb0e31SAlexander Graf         /* ipl */
1327337c6ebSDavid Hildenbrand         qemu_mutex_lock_iothread();
133968db419SDavid Hildenbrand         handle_diag_308(env, r1, r3, GETPC());
1347337c6ebSDavid Hildenbrand         qemu_mutex_unlock_iothread();
135defb0e31SAlexander Graf         r = 0;
136defb0e31SAlexander Graf         break;
137eb569af8SCornelia Huck     case 0x288:
138eb569af8SCornelia Huck         /* time bomb (watchdog) */
139eb569af8SCornelia Huck         r = handle_diag_288(env, r1, r3);
140eb569af8SCornelia Huck         break;
141defb0e31SAlexander Graf     default:
142defb0e31SAlexander Graf         r = -1;
143defb0e31SAlexander Graf         break;
144defb0e31SAlexander Graf     }
145defb0e31SAlexander Graf 
146defb0e31SAlexander Graf     if (r) {
1471e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, GETPC());
148defb0e31SAlexander Graf     }
149defb0e31SAlexander Graf }
150defb0e31SAlexander Graf 
151defb0e31SAlexander Graf /* Set Prefix */
152089f5c06SBlue Swirl void HELPER(spx)(CPUS390XState *env, uint64_t a1)
153defb0e31SAlexander Graf {
154dc79e928SRichard Henderson     CPUState *cs = env_cpu(env);
155e805a0d3SRichard Henderson     uint32_t prefix = a1 & 0x7fffe000;
15631b030d4SAndreas Färber 
157e805a0d3SRichard Henderson     env->psa = prefix;
158aafcf80eSPaolo Bonzini     HELPER_LOG("prefix: %#x\n", prefix);
15931b030d4SAndreas Färber     tlb_flush_page(cs, 0);
16031b030d4SAndreas Färber     tlb_flush_page(cs, TARGET_PAGE_SIZE);
161defb0e31SAlexander Graf }
162defb0e31SAlexander Graf 
16330c8db0eSDavid Hildenbrand static void update_ckc_timer(CPUS390XState *env)
164defb0e31SAlexander Graf {
1657de3b1cdSDavid Hildenbrand     S390TODState *td = s390_get_todstate();
16630c8db0eSDavid Hildenbrand     uint64_t time;
1677de3b1cdSDavid Hildenbrand 
168345f1ab9SDavid Hildenbrand     /* stop the timer and remove pending CKC IRQs */
169345f1ab9SDavid Hildenbrand     timer_del(env->tod_timer);
17030c8db0eSDavid Hildenbrand     g_assert(qemu_mutex_iothread_locked());
171345f1ab9SDavid Hildenbrand     env->pending_int &= ~INTERRUPT_EXT_CLOCK_COMPARATOR;
172345f1ab9SDavid Hildenbrand 
173345f1ab9SDavid Hildenbrand     /* the tod has to exceed the ckc, this can never happen if ckc is all 1's */
17430c8db0eSDavid Hildenbrand     if (env->ckc == -1ULL) {
175defb0e31SAlexander Graf         return;
176defb0e31SAlexander Graf     }
177defb0e31SAlexander Graf 
178c941f074SAurelien Jarno     /* difference between origins */
17930c8db0eSDavid Hildenbrand     time = env->ckc - td->base.low;
180c941f074SAurelien Jarno 
181defb0e31SAlexander Graf     /* nanoseconds */
1829cb32c44SAurelien Jarno     time = tod2time(time);
183defb0e31SAlexander Graf 
184f777b205SDavid Hildenbrand     timer_mod(env->tod_timer, time);
185defb0e31SAlexander Graf }
186defb0e31SAlexander Graf 
18730c8db0eSDavid Hildenbrand /* Set Clock Comparator */
18830c8db0eSDavid Hildenbrand void HELPER(sckc)(CPUS390XState *env, uint64_t ckc)
18930c8db0eSDavid Hildenbrand {
19030c8db0eSDavid Hildenbrand     env->ckc = ckc;
19130c8db0eSDavid Hildenbrand 
19230c8db0eSDavid Hildenbrand     qemu_mutex_lock_iothread();
19330c8db0eSDavid Hildenbrand     update_ckc_timer(env);
19430c8db0eSDavid Hildenbrand     qemu_mutex_unlock_iothread();
19530c8db0eSDavid Hildenbrand }
19630c8db0eSDavid Hildenbrand 
1977de3b1cdSDavid Hildenbrand void tcg_s390_tod_updated(CPUState *cs, run_on_cpu_data opaque)
1987de3b1cdSDavid Hildenbrand {
1997de3b1cdSDavid Hildenbrand     S390CPU *cpu = S390_CPU(cs);
2007de3b1cdSDavid Hildenbrand 
20130c8db0eSDavid Hildenbrand     update_ckc_timer(&cpu->env);
2027de3b1cdSDavid Hildenbrand }
2037de3b1cdSDavid Hildenbrand 
2049dc67537SDavid Hildenbrand /* Set Clock */
2059dc67537SDavid Hildenbrand uint32_t HELPER(sck)(CPUS390XState *env, uint64_t tod_low)
2069dc67537SDavid Hildenbrand {
2079dc67537SDavid Hildenbrand     S390TODState *td = s390_get_todstate();
2089dc67537SDavid Hildenbrand     S390TODClass *tdc = S390_TOD_GET_CLASS(td);
2099dc67537SDavid Hildenbrand     S390TOD tod = {
2109dc67537SDavid Hildenbrand         .high = 0,
2119dc67537SDavid Hildenbrand         .low = tod_low,
2129dc67537SDavid Hildenbrand     };
2139dc67537SDavid Hildenbrand 
2149dc67537SDavid Hildenbrand     qemu_mutex_lock_iothread();
2159dc67537SDavid Hildenbrand     tdc->set(td, &tod, &error_abort);
2169dc67537SDavid Hildenbrand     qemu_mutex_unlock_iothread();
2179dc67537SDavid Hildenbrand     return 0;
2189dc67537SDavid Hildenbrand }
2199dc67537SDavid Hildenbrand 
220257a119eSDavid Hildenbrand /* Set Tod Programmable Field */
221257a119eSDavid Hildenbrand void HELPER(sckpf)(CPUS390XState *env, uint64_t r0)
222257a119eSDavid Hildenbrand {
223257a119eSDavid Hildenbrand     uint32_t val = r0;
224257a119eSDavid Hildenbrand 
225257a119eSDavid Hildenbrand     if (val & 0xffff0000) {
2261e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, GETPC());
227257a119eSDavid Hildenbrand     }
228257a119eSDavid Hildenbrand     env->todpr = val;
229257a119eSDavid Hildenbrand }
230257a119eSDavid Hildenbrand 
231defb0e31SAlexander Graf /* Store Clock Comparator */
232dd3eb7b5SRichard Henderson uint64_t HELPER(stckc)(CPUS390XState *env)
233defb0e31SAlexander Graf {
234aa9e14e6SAurelien Jarno     return env->ckc;
235defb0e31SAlexander Graf }
236defb0e31SAlexander Graf 
237defb0e31SAlexander Graf /* Set CPU Timer */
238c4f0a863SRichard Henderson void HELPER(spt)(CPUS390XState *env, uint64_t time)
239defb0e31SAlexander Graf {
240defb0e31SAlexander Graf     if (time == -1ULL) {
241defb0e31SAlexander Graf         return;
242defb0e31SAlexander Graf     }
243defb0e31SAlexander Graf 
244defb0e31SAlexander Graf     /* nanoseconds */
2459cb32c44SAurelien Jarno     time = tod2time(time);
246defb0e31SAlexander Graf 
247b8ae94bdSAurelien Jarno     env->cputm = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + time;
248b8ae94bdSAurelien Jarno 
249b8ae94bdSAurelien Jarno     timer_mod(env->cpu_timer, env->cputm);
250defb0e31SAlexander Graf }
251defb0e31SAlexander Graf 
252defb0e31SAlexander Graf /* Store System Information */
25379947862SDavid Hildenbrand uint32_t HELPER(stsi)(CPUS390XState *env, uint64_t a0, uint64_t r0, uint64_t r1)
254defb0e31SAlexander Graf {
25579947862SDavid Hildenbrand     const uintptr_t ra = GETPC();
25679947862SDavid Hildenbrand     const uint32_t sel1 = r0 & STSI_R0_SEL1_MASK;
25779947862SDavid Hildenbrand     const uint32_t sel2 = r1 & STSI_R1_SEL2_MASK;
25879947862SDavid Hildenbrand     const MachineState *ms = MACHINE(qdev_get_machine());
25979947862SDavid Hildenbrand     uint16_t total_cpus = 0, conf_cpus = 0, reserved_cpus = 0;
260dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
261b0dad618SRichard Henderson     SysIB sysib = { };
26279947862SDavid Hildenbrand     int i, cc = 0;
263defb0e31SAlexander Graf 
26479947862SDavid Hildenbrand     if ((r0 & STSI_R0_FC_MASK) > STSI_R0_FC_LEVEL_3) {
26579947862SDavid Hildenbrand         /* invalid function code: no other checks are performed */
26679947862SDavid Hildenbrand         return 3;
267defb0e31SAlexander Graf     }
268defb0e31SAlexander Graf 
26979947862SDavid Hildenbrand     if ((r0 & STSI_R0_RESERVED_MASK) || (r1 & STSI_R1_RESERVED_MASK)) {
2701e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, ra);
27179947862SDavid Hildenbrand     }
272defb0e31SAlexander Graf 
27379947862SDavid Hildenbrand     if ((r0 & STSI_R0_FC_MASK) == STSI_R0_FC_CURRENT) {
27479947862SDavid Hildenbrand         /* query the current level: no further checks are performed */
27579947862SDavid Hildenbrand         env->regs[0] = STSI_R0_FC_LEVEL_3;
27679947862SDavid Hildenbrand         return 0;
27779947862SDavid Hildenbrand     }
278defb0e31SAlexander Graf 
27979947862SDavid Hildenbrand     if (a0 & ~TARGET_PAGE_MASK) {
2801e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, ra);
28179947862SDavid Hildenbrand     }
28279947862SDavid Hildenbrand 
28379947862SDavid Hildenbrand     /* count the cpus and split them into configured and reserved ones */
28479947862SDavid Hildenbrand     for (i = 0; i < ms->possible_cpus->len; i++) {
28579947862SDavid Hildenbrand         total_cpus++;
28679947862SDavid Hildenbrand         if (ms->possible_cpus->cpus[i].cpu) {
28779947862SDavid Hildenbrand             conf_cpus++;
28879947862SDavid Hildenbrand         } else {
28979947862SDavid Hildenbrand             reserved_cpus++;
29079947862SDavid Hildenbrand         }
29179947862SDavid Hildenbrand     }
29279947862SDavid Hildenbrand 
29379947862SDavid Hildenbrand     /*
29479947862SDavid Hildenbrand      * In theory, we could report Level 1 / Level 2 as current. However,
29579947862SDavid Hildenbrand      * the Linux kernel will detect this as running under LPAR and assume
29679947862SDavid Hildenbrand      * that we have a sclp linemode console (which is always present on
29779947862SDavid Hildenbrand      * LPAR, but not the default for QEMU), therefore not displaying boot
29879947862SDavid Hildenbrand      * messages and making booting a Linux kernel under TCG harder.
29979947862SDavid Hildenbrand      *
30079947862SDavid Hildenbrand      * For now we fake the same SMP configuration on all levels.
30179947862SDavid Hildenbrand      *
30279947862SDavid Hildenbrand      * TODO: We could later make the level configurable via the machine
30379947862SDavid Hildenbrand      *       and change defaults (linemode console) based on machine type
30479947862SDavid Hildenbrand      *       and accelerator.
30579947862SDavid Hildenbrand      */
30679947862SDavid Hildenbrand     switch (r0 & STSI_R0_FC_MASK) {
30779947862SDavid Hildenbrand     case STSI_R0_FC_LEVEL_1:
308defb0e31SAlexander Graf         if ((sel1 == 1) && (sel2 == 1)) {
309defb0e31SAlexander Graf             /* Basic Machine Configuration */
310076d4d39SDavid Hildenbrand             char type[5] = {};
311defb0e31SAlexander Graf 
31279947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_111.manuf, "QEMU            ", 16);
313076d4d39SDavid Hildenbrand             /* same as machine type number in STORE CPU ID, but in EBCDIC */
314076d4d39SDavid Hildenbrand             snprintf(type, ARRAY_SIZE(type), "%X", cpu->model->def->type);
31579947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_111.type, type, 4);
316076d4d39SDavid Hildenbrand             /* model number (not stored in STORE CPU ID for z/Architecure) */
31779947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_111.model, "QEMU            ", 16);
31879947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_111.sequence, "QEMU            ", 16);
31979947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_111.plant, "QEMU", 4);
320defb0e31SAlexander Graf         } else if ((sel1 == 2) && (sel2 == 1)) {
321defb0e31SAlexander Graf             /* Basic Machine CPU */
32279947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_121.sequence, "QEMUQEMUQEMUQEMU", 16);
32379947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_121.plant, "QEMU", 4);
32479947862SDavid Hildenbrand             sysib.sysib_121.cpu_addr = cpu_to_be16(env->core_id);
325defb0e31SAlexander Graf         } else if ((sel1 == 2) && (sel2 == 2)) {
326defb0e31SAlexander Graf             /* Basic Machine CPUs */
32779947862SDavid Hildenbrand             sysib.sysib_122.capability = cpu_to_be32(0x443afc29);
32879947862SDavid Hildenbrand             sysib.sysib_122.total_cpus = cpu_to_be16(total_cpus);
32979947862SDavid Hildenbrand             sysib.sysib_122.conf_cpus = cpu_to_be16(conf_cpus);
33079947862SDavid Hildenbrand             sysib.sysib_122.reserved_cpus = cpu_to_be16(reserved_cpus);
331defb0e31SAlexander Graf         } else {
332defb0e31SAlexander Graf             cc = 3;
333defb0e31SAlexander Graf         }
334defb0e31SAlexander Graf         break;
33579947862SDavid Hildenbrand     case STSI_R0_FC_LEVEL_2:
336defb0e31SAlexander Graf         if ((sel1 == 2) && (sel2 == 1)) {
337defb0e31SAlexander Graf             /* LPAR CPU */
33879947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_221.sequence, "QEMUQEMUQEMUQEMU", 16);
33979947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_221.plant, "QEMU", 4);
34079947862SDavid Hildenbrand             sysib.sysib_221.cpu_addr = cpu_to_be16(env->core_id);
341defb0e31SAlexander Graf         } else if ((sel1 == 2) && (sel2 == 2)) {
342defb0e31SAlexander Graf             /* LPAR CPUs */
34379947862SDavid Hildenbrand             sysib.sysib_222.lcpuc = 0x80; /* dedicated */
34479947862SDavid Hildenbrand             sysib.sysib_222.total_cpus = cpu_to_be16(total_cpus);
34579947862SDavid Hildenbrand             sysib.sysib_222.conf_cpus = cpu_to_be16(conf_cpus);
34679947862SDavid Hildenbrand             sysib.sysib_222.reserved_cpus = cpu_to_be16(reserved_cpus);
34779947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_222.name, "QEMU    ", 8);
34879947862SDavid Hildenbrand             sysib.sysib_222.caf = cpu_to_be32(1000);
34979947862SDavid Hildenbrand             sysib.sysib_222.dedicated_cpus = cpu_to_be16(conf_cpus);
350defb0e31SAlexander Graf         } else {
351defb0e31SAlexander Graf             cc = 3;
352defb0e31SAlexander Graf         }
353defb0e31SAlexander Graf         break;
35479947862SDavid Hildenbrand     case STSI_R0_FC_LEVEL_3:
355defb0e31SAlexander Graf         if ((sel1 == 2) && (sel2 == 2)) {
356defb0e31SAlexander Graf             /* VM CPUs */
35779947862SDavid Hildenbrand             sysib.sysib_322.count = 1;
35879947862SDavid Hildenbrand             sysib.sysib_322.vm[0].total_cpus = cpu_to_be16(total_cpus);
35979947862SDavid Hildenbrand             sysib.sysib_322.vm[0].conf_cpus = cpu_to_be16(conf_cpus);
36079947862SDavid Hildenbrand             sysib.sysib_322.vm[0].reserved_cpus = cpu_to_be16(reserved_cpus);
36179947862SDavid Hildenbrand             sysib.sysib_322.vm[0].caf = cpu_to_be32(1000);
36279947862SDavid Hildenbrand             /* Linux kernel uses this to distinguish us from z/VM */
36379947862SDavid Hildenbrand             ebcdic_put(sysib.sysib_322.vm[0].cpi, "KVM/Linux       ", 16);
36479947862SDavid Hildenbrand             sysib.sysib_322.vm[0].ext_name_encoding = 2; /* UTF-8 */
365defb0e31SAlexander Graf 
36679947862SDavid Hildenbrand             /* If our VM has a name, use the real name */
36779947862SDavid Hildenbrand             if (qemu_name) {
36879947862SDavid Hildenbrand                 memset(sysib.sysib_322.vm[0].name, 0x40,
36979947862SDavid Hildenbrand                        sizeof(sysib.sysib_322.vm[0].name));
37079947862SDavid Hildenbrand                 ebcdic_put(sysib.sysib_322.vm[0].name, qemu_name,
37179947862SDavid Hildenbrand                            MIN(sizeof(sysib.sysib_322.vm[0].name),
37279947862SDavid Hildenbrand                                strlen(qemu_name)));
373*e6a80232SMiroslav Rezanina                 strpadcpy((char *)sysib.sysib_322.ext_names[0],
374*e6a80232SMiroslav Rezanina                           sizeof(sysib.sysib_322.ext_names[0]),
375*e6a80232SMiroslav Rezanina                           qemu_name, '\0');
376*e6a80232SMiroslav Rezanina 
37779947862SDavid Hildenbrand             } else {
37879947862SDavid Hildenbrand                 ebcdic_put(sysib.sysib_322.vm[0].name, "TCGguest", 8);
37979947862SDavid Hildenbrand                 strcpy((char *)sysib.sysib_322.ext_names[0], "TCGguest");
38079947862SDavid Hildenbrand             }
38179947862SDavid Hildenbrand 
38279947862SDavid Hildenbrand             /* add the uuid */
38379947862SDavid Hildenbrand             memcpy(sysib.sysib_322.vm[0].uuid, &qemu_uuid,
38479947862SDavid Hildenbrand                    sizeof(sysib.sysib_322.vm[0].uuid));
385defb0e31SAlexander Graf         } else {
386defb0e31SAlexander Graf             cc = 3;
387defb0e31SAlexander Graf         }
388defb0e31SAlexander Graf         break;
389defb0e31SAlexander Graf     }
39079947862SDavid Hildenbrand 
39179947862SDavid Hildenbrand     if (cc == 0) {
39279947862SDavid Hildenbrand         if (s390_cpu_virt_mem_write(cpu, a0, 0, &sysib, sizeof(sysib))) {
39379947862SDavid Hildenbrand             s390_cpu_virt_mem_handle_exc(cpu, ra);
39479947862SDavid Hildenbrand         }
395defb0e31SAlexander Graf     }
396defb0e31SAlexander Graf 
397defb0e31SAlexander Graf     return cc;
398defb0e31SAlexander Graf }
399defb0e31SAlexander Graf 
400089f5c06SBlue Swirl uint32_t HELPER(sigp)(CPUS390XState *env, uint64_t order_code, uint32_t r1,
40111b0079cSDavid Hildenbrand                       uint32_t r3)
402defb0e31SAlexander Graf {
40311b0079cSDavid Hildenbrand     int cc;
404defb0e31SAlexander Graf 
40511b0079cSDavid Hildenbrand     /* TODO: needed to inject interrupts  - push further down */
40611b0079cSDavid Hildenbrand     qemu_mutex_lock_iothread();
40711b0079cSDavid Hildenbrand     cc = handle_sigp(env, order_code & SIGP_ORDER_MASK, r1, r3);
40811b0079cSDavid Hildenbrand     qemu_mutex_unlock_iothread();
409defb0e31SAlexander Graf 
410defb0e31SAlexander Graf     return cc;
411defb0e31SAlexander Graf }
412defb0e31SAlexander Graf #endif
413ad8a4570SAlexander Graf 
414ad8a4570SAlexander Graf #ifndef CONFIG_USER_ONLY
415ad8a4570SAlexander Graf void HELPER(xsch)(CPUS390XState *env, uint64_t r1)
416ad8a4570SAlexander Graf {
417dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
418278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4191b98fb99SDavid Hildenbrand     ioinst_handle_xsch(cpu, r1, GETPC());
420278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
421ad8a4570SAlexander Graf }
422ad8a4570SAlexander Graf 
423ad8a4570SAlexander Graf void HELPER(csch)(CPUS390XState *env, uint64_t r1)
424ad8a4570SAlexander Graf {
425dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
426278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4271b98fb99SDavid Hildenbrand     ioinst_handle_csch(cpu, r1, GETPC());
428278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
429ad8a4570SAlexander Graf }
430ad8a4570SAlexander Graf 
431ad8a4570SAlexander Graf void HELPER(hsch)(CPUS390XState *env, uint64_t r1)
432ad8a4570SAlexander Graf {
433dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
434278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4351b98fb99SDavid Hildenbrand     ioinst_handle_hsch(cpu, r1, GETPC());
436278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
437ad8a4570SAlexander Graf }
438ad8a4570SAlexander Graf 
439ad8a4570SAlexander Graf void HELPER(msch)(CPUS390XState *env, uint64_t r1, uint64_t inst)
440ad8a4570SAlexander Graf {
441dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
442278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4431b98fb99SDavid Hildenbrand     ioinst_handle_msch(cpu, r1, inst >> 16, GETPC());
444278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
445ad8a4570SAlexander Graf }
446ad8a4570SAlexander Graf 
447ad8a4570SAlexander Graf void HELPER(rchp)(CPUS390XState *env, uint64_t r1)
448ad8a4570SAlexander Graf {
449dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
450278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4511b98fb99SDavid Hildenbrand     ioinst_handle_rchp(cpu, r1, GETPC());
452278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
453ad8a4570SAlexander Graf }
454ad8a4570SAlexander Graf 
455ad8a4570SAlexander Graf void HELPER(rsch)(CPUS390XState *env, uint64_t r1)
456ad8a4570SAlexander Graf {
457dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
458278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4591b98fb99SDavid Hildenbrand     ioinst_handle_rsch(cpu, r1, GETPC());
460278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
461ad8a4570SAlexander Graf }
462ad8a4570SAlexander Graf 
46386c34633SDavid Hildenbrand void HELPER(sal)(CPUS390XState *env, uint64_t r1)
46486c34633SDavid Hildenbrand {
465dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
46686c34633SDavid Hildenbrand 
46786c34633SDavid Hildenbrand     qemu_mutex_lock_iothread();
46886c34633SDavid Hildenbrand     ioinst_handle_sal(cpu, r1, GETPC());
46986c34633SDavid Hildenbrand     qemu_mutex_unlock_iothread();
47086c34633SDavid Hildenbrand }
47186c34633SDavid Hildenbrand 
472a9de75a0SDavid Hildenbrand void HELPER(schm)(CPUS390XState *env, uint64_t r1, uint64_t r2, uint64_t inst)
473a9de75a0SDavid Hildenbrand {
474dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
475a9de75a0SDavid Hildenbrand 
476a9de75a0SDavid Hildenbrand     qemu_mutex_lock_iothread();
477a9de75a0SDavid Hildenbrand     ioinst_handle_schm(cpu, r1, r2, inst >> 16, GETPC());
478a9de75a0SDavid Hildenbrand     qemu_mutex_unlock_iothread();
479a9de75a0SDavid Hildenbrand }
480a9de75a0SDavid Hildenbrand 
481ad8a4570SAlexander Graf void HELPER(ssch)(CPUS390XState *env, uint64_t r1, uint64_t inst)
482ad8a4570SAlexander Graf {
483dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
484278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
4851b98fb99SDavid Hildenbrand     ioinst_handle_ssch(cpu, r1, inst >> 16, GETPC());
486278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
487ad8a4570SAlexander Graf }
488ad8a4570SAlexander Graf 
4895a59bc1dSDavid Hildenbrand void HELPER(stcrw)(CPUS390XState *env, uint64_t inst)
4905a59bc1dSDavid Hildenbrand {
491dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
4925a59bc1dSDavid Hildenbrand 
4935a59bc1dSDavid Hildenbrand     qemu_mutex_lock_iothread();
4945a59bc1dSDavid Hildenbrand     ioinst_handle_stcrw(cpu, inst >> 16, GETPC());
4955a59bc1dSDavid Hildenbrand     qemu_mutex_unlock_iothread();
4965a59bc1dSDavid Hildenbrand }
4975a59bc1dSDavid Hildenbrand 
498ad8a4570SAlexander Graf void HELPER(stsch)(CPUS390XState *env, uint64_t r1, uint64_t inst)
499ad8a4570SAlexander Graf {
500dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
501278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
5021b98fb99SDavid Hildenbrand     ioinst_handle_stsch(cpu, r1, inst >> 16, GETPC());
503278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
504ad8a4570SAlexander Graf }
505ad8a4570SAlexander Graf 
5066a253de3SDavid Hildenbrand uint32_t HELPER(tpi)(CPUS390XState *env, uint64_t addr)
5076a253de3SDavid Hildenbrand {
5086a253de3SDavid Hildenbrand     const uintptr_t ra = GETPC();
509dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
510f68ecdd4SDavid Hildenbrand     QEMUS390FLICState *flic = s390_get_qemu_flic(s390_get_flic());
5116a253de3SDavid Hildenbrand     QEMUS390FlicIO *io = NULL;
5126a253de3SDavid Hildenbrand     LowCore *lowcore;
5136a253de3SDavid Hildenbrand 
5146a253de3SDavid Hildenbrand     if (addr & 0x3) {
5151e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, ra);
5166a253de3SDavid Hildenbrand     }
5176a253de3SDavid Hildenbrand 
5186a253de3SDavid Hildenbrand     qemu_mutex_lock_iothread();
5196a253de3SDavid Hildenbrand     io = qemu_s390_flic_dequeue_io(flic, env->cregs[6]);
5206a253de3SDavid Hildenbrand     if (!io) {
5216a253de3SDavid Hildenbrand         qemu_mutex_unlock_iothread();
5226a253de3SDavid Hildenbrand         return 0;
5236a253de3SDavid Hildenbrand     }
5246a253de3SDavid Hildenbrand 
5256a253de3SDavid Hildenbrand     if (addr) {
5266a253de3SDavid Hildenbrand         struct {
5276a253de3SDavid Hildenbrand             uint16_t id;
5286a253de3SDavid Hildenbrand             uint16_t nr;
5296a253de3SDavid Hildenbrand             uint32_t parm;
5306a253de3SDavid Hildenbrand         } intc = {
5316a253de3SDavid Hildenbrand             .id = cpu_to_be16(io->id),
5326a253de3SDavid Hildenbrand             .nr = cpu_to_be16(io->nr),
5336a253de3SDavid Hildenbrand             .parm = cpu_to_be32(io->parm),
5346a253de3SDavid Hildenbrand         };
5356a253de3SDavid Hildenbrand 
5366a253de3SDavid Hildenbrand         if (s390_cpu_virt_mem_write(cpu, addr, 0, &intc, sizeof(intc))) {
5376a253de3SDavid Hildenbrand             /* writing failed, reinject and properly clean up */
5386a253de3SDavid Hildenbrand             s390_io_interrupt(io->id, io->nr, io->parm, io->word);
5396a253de3SDavid Hildenbrand             qemu_mutex_unlock_iothread();
5406a253de3SDavid Hildenbrand             g_free(io);
5416a253de3SDavid Hildenbrand             s390_cpu_virt_mem_handle_exc(cpu, ra);
5426a253de3SDavid Hildenbrand             return 0;
5436a253de3SDavid Hildenbrand         }
5446a253de3SDavid Hildenbrand     } else {
5456a253de3SDavid Hildenbrand         /* no protection applies */
5466a253de3SDavid Hildenbrand         lowcore = cpu_map_lowcore(env);
5476a253de3SDavid Hildenbrand         lowcore->subchannel_id = cpu_to_be16(io->id);
5486a253de3SDavid Hildenbrand         lowcore->subchannel_nr = cpu_to_be16(io->nr);
5496a253de3SDavid Hildenbrand         lowcore->io_int_parm = cpu_to_be32(io->parm);
5506a253de3SDavid Hildenbrand         lowcore->io_int_word = cpu_to_be32(io->word);
5516a253de3SDavid Hildenbrand         cpu_unmap_lowcore(lowcore);
5526a253de3SDavid Hildenbrand     }
5536a253de3SDavid Hildenbrand 
5546a253de3SDavid Hildenbrand     g_free(io);
5556a253de3SDavid Hildenbrand     qemu_mutex_unlock_iothread();
5566a253de3SDavid Hildenbrand     return 1;
5576a253de3SDavid Hildenbrand }
5586a253de3SDavid Hildenbrand 
559ad8a4570SAlexander Graf void HELPER(tsch)(CPUS390XState *env, uint64_t r1, uint64_t inst)
560ad8a4570SAlexander Graf {
561dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
562278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
5631b98fb99SDavid Hildenbrand     ioinst_handle_tsch(cpu, r1, inst >> 16, GETPC());
564278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
565ad8a4570SAlexander Graf }
566ad8a4570SAlexander Graf 
567ad8a4570SAlexander Graf void HELPER(chsc)(CPUS390XState *env, uint64_t inst)
568ad8a4570SAlexander Graf {
569dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
570278f5e98SAlex Bennée     qemu_mutex_lock_iothread();
5711b98fb99SDavid Hildenbrand     ioinst_handle_chsc(cpu, inst >> 16, GETPC());
572278f5e98SAlex Bennée     qemu_mutex_unlock_iothread();
573ad8a4570SAlexander Graf }
574ad8a4570SAlexander Graf #endif
575777c98c3SAurelien Jarno 
576777c98c3SAurelien Jarno #ifndef CONFIG_USER_ONLY
577777c98c3SAurelien Jarno void HELPER(per_check_exception)(CPUS390XState *env)
578777c98c3SAurelien Jarno {
579777c98c3SAurelien Jarno     if (env->per_perc_atmid) {
5801e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_PER, GETPC());
581777c98c3SAurelien Jarno     }
582777c98c3SAurelien Jarno }
5832c2275ebSAurelien Jarno 
584d9b8daf9SDavid Hildenbrand /* Check if an address is within the PER starting address and the PER
585d9b8daf9SDavid Hildenbrand    ending address.  The address range might loop.  */
586d9b8daf9SDavid Hildenbrand static inline bool get_per_in_range(CPUS390XState *env, uint64_t addr)
587d9b8daf9SDavid Hildenbrand {
588d9b8daf9SDavid Hildenbrand     if (env->cregs[10] <= env->cregs[11]) {
589d9b8daf9SDavid Hildenbrand         return env->cregs[10] <= addr && addr <= env->cregs[11];
590d9b8daf9SDavid Hildenbrand     } else {
591d9b8daf9SDavid Hildenbrand         return env->cregs[10] <= addr || addr <= env->cregs[11];
592d9b8daf9SDavid Hildenbrand     }
593d9b8daf9SDavid Hildenbrand }
594d9b8daf9SDavid Hildenbrand 
5952c2275ebSAurelien Jarno void HELPER(per_branch)(CPUS390XState *env, uint64_t from, uint64_t to)
5962c2275ebSAurelien Jarno {
5972c2275ebSAurelien Jarno     if ((env->cregs[9] & PER_CR9_EVENT_BRANCH)) {
5982c2275ebSAurelien Jarno         if (!(env->cregs[9] & PER_CR9_CONTROL_BRANCH_ADDRESS)
5992c2275ebSAurelien Jarno             || get_per_in_range(env, to)) {
6002c2275ebSAurelien Jarno             env->per_address = from;
6012c2275ebSAurelien Jarno             env->per_perc_atmid = PER_CODE_EVENT_BRANCH | get_per_atmid(env);
6022c2275ebSAurelien Jarno         }
6032c2275ebSAurelien Jarno     }
6042c2275ebSAurelien Jarno }
605f0e0d817SAurelien Jarno 
606f0e0d817SAurelien Jarno void HELPER(per_ifetch)(CPUS390XState *env, uint64_t addr)
607f0e0d817SAurelien Jarno {
608f0e0d817SAurelien Jarno     if ((env->cregs[9] & PER_CR9_EVENT_IFETCH) && get_per_in_range(env, addr)) {
609f0e0d817SAurelien Jarno         env->per_address = addr;
610f0e0d817SAurelien Jarno         env->per_perc_atmid = PER_CODE_EVENT_IFETCH | get_per_atmid(env);
61183bb1612SAurelien Jarno 
61283bb1612SAurelien Jarno         /* If the instruction has to be nullified, trigger the
61383bb1612SAurelien Jarno            exception immediately. */
61483bb1612SAurelien Jarno         if (env->cregs[9] & PER_CR9_EVENT_NULLIFICATION) {
615dc79e928SRichard Henderson             CPUState *cs = env_cpu(env);
61683bb1612SAurelien Jarno 
617465aec46SDavid Hildenbrand             env->per_perc_atmid |= PER_CODE_EVENT_NULLIFICATION;
61883bb1612SAurelien Jarno             env->int_pgm_code = PGM_PER;
61983bb1612SAurelien Jarno             env->int_pgm_ilen = get_ilen(cpu_ldub_code(env, addr));
62083bb1612SAurelien Jarno 
62183bb1612SAurelien Jarno             cs->exception_index = EXCP_PGM;
62283bb1612SAurelien Jarno             cpu_loop_exit(cs);
62383bb1612SAurelien Jarno         }
624f0e0d817SAurelien Jarno     }
625f0e0d817SAurelien Jarno }
626ebed683cSRichard Henderson 
627ebed683cSRichard Henderson void HELPER(per_store_real)(CPUS390XState *env)
628ebed683cSRichard Henderson {
629ebed683cSRichard Henderson     if ((env->cregs[9] & PER_CR9_EVENT_STORE) &&
630ebed683cSRichard Henderson         (env->cregs[9] & PER_CR9_EVENT_STORE_REAL)) {
631ebed683cSRichard Henderson         /* PSW is saved just before calling the helper.  */
632ebed683cSRichard Henderson         env->per_address = env->psw.addr;
633ebed683cSRichard Henderson         env->per_perc_atmid = PER_CODE_EVENT_STORE_REAL | get_per_atmid(env);
634ebed683cSRichard Henderson     }
635ebed683cSRichard Henderson }
636777c98c3SAurelien Jarno #endif
6375bf83628SRichard Henderson 
638f74990a5SDavid Hildenbrand static uint8_t stfl_bytes[2048];
639f74990a5SDavid Hildenbrand static unsigned int used_stfl_bytes;
6405bf83628SRichard Henderson 
641f74990a5SDavid Hildenbrand static void prepare_stfl(void)
6425bf83628SRichard Henderson {
643f74990a5SDavid Hildenbrand     static bool initialized;
644f74990a5SDavid Hildenbrand     int i;
6455bf83628SRichard Henderson 
646f74990a5SDavid Hildenbrand     /* racy, but we don't care, the same values are always written */
647f74990a5SDavid Hildenbrand     if (initialized) {
648f74990a5SDavid Hildenbrand         return;
6495bf83628SRichard Henderson     }
6505bf83628SRichard Henderson 
651f74990a5SDavid Hildenbrand     s390_get_feat_block(S390_FEAT_TYPE_STFL, stfl_bytes);
652f74990a5SDavid Hildenbrand     for (i = 0; i < sizeof(stfl_bytes); i++) {
653f74990a5SDavid Hildenbrand         if (stfl_bytes[i]) {
654f74990a5SDavid Hildenbrand             used_stfl_bytes = i + 1;
6555bf83628SRichard Henderson         }
6565bf83628SRichard Henderson     }
657f74990a5SDavid Hildenbrand     initialized = true;
6585bf83628SRichard Henderson }
6595bf83628SRichard Henderson 
66086b5ab39SDavid Hildenbrand #ifndef CONFIG_USER_ONLY
6615bf83628SRichard Henderson void HELPER(stfl)(CPUS390XState *env)
6625bf83628SRichard Henderson {
66386b5ab39SDavid Hildenbrand     LowCore *lowcore;
6645bf83628SRichard Henderson 
66586b5ab39SDavid Hildenbrand     lowcore = cpu_map_lowcore(env);
666f74990a5SDavid Hildenbrand     prepare_stfl();
667f74990a5SDavid Hildenbrand     memcpy(&lowcore->stfl_fac_list, stfl_bytes, sizeof(lowcore->stfl_fac_list));
66886b5ab39SDavid Hildenbrand     cpu_unmap_lowcore(lowcore);
6695bf83628SRichard Henderson }
67086b5ab39SDavid Hildenbrand #endif
6715bf83628SRichard Henderson 
6725bf83628SRichard Henderson uint32_t HELPER(stfle)(CPUS390XState *env, uint64_t addr)
6735bf83628SRichard Henderson {
674f74990a5SDavid Hildenbrand     const uintptr_t ra = GETPC();
675f74990a5SDavid Hildenbrand     const int count_bytes = ((env->regs[0] & 0xff) + 1) * 8;
67688a29e86SDavid Hildenbrand     int max_bytes;
677f74990a5SDavid Hildenbrand     int i;
6785bf83628SRichard Henderson 
679f74990a5SDavid Hildenbrand     if (addr & 0x7) {
6801e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, PGM_SPECIFICATION, ra);
6815bf83628SRichard Henderson     }
6825bf83628SRichard Henderson 
683f74990a5SDavid Hildenbrand     prepare_stfl();
68488a29e86SDavid Hildenbrand     max_bytes = ROUND_UP(used_stfl_bytes, 8);
685e19a61ebSDavid Hildenbrand 
686e19a61ebSDavid Hildenbrand     /*
687e19a61ebSDavid Hildenbrand      * The PoP says that doublewords beyond the highest-numbered facility
688e19a61ebSDavid Hildenbrand      * bit may or may not be stored.  However, existing hardware appears to
689e19a61ebSDavid Hildenbrand      * not store the words, and existing software depend on that.
690e19a61ebSDavid Hildenbrand      */
691e19a61ebSDavid Hildenbrand     for (i = 0; i < MIN(count_bytes, max_bytes); ++i) {
692f74990a5SDavid Hildenbrand         cpu_stb_data_ra(env, addr + i, stfl_bytes[i], ra);
693f74990a5SDavid Hildenbrand     }
694f74990a5SDavid Hildenbrand 
695f74990a5SDavid Hildenbrand     env->regs[0] = deposit64(env->regs[0], 0, 8, (max_bytes / 8) - 1);
696f74990a5SDavid Hildenbrand     return count_bytes >= max_bytes ? 0 : 3;
6975bf83628SRichard Henderson }
698f6c232ceSCornelia Huck 
699f6c232ceSCornelia Huck #ifndef CONFIG_USER_ONLY
700f6c232ceSCornelia Huck /*
701f6c232ceSCornelia Huck  * Note: we ignore any return code of the functions called for the pci
702f6c232ceSCornelia Huck  * instructions, as the only time they return !0 is when the stub is
703f6c232ceSCornelia Huck  * called, and in that case we didn't even offer the zpci facility.
704f6c232ceSCornelia Huck  * The only exception is SIC, where program checks need to be handled
705f6c232ceSCornelia Huck  * by the caller.
706f6c232ceSCornelia Huck  */
707f6c232ceSCornelia Huck void HELPER(clp)(CPUS390XState *env, uint32_t r2)
708f6c232ceSCornelia Huck {
709dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
710f6c232ceSCornelia Huck 
711f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
712f6c232ceSCornelia Huck     clp_service_call(cpu, r2, GETPC());
713f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
714f6c232ceSCornelia Huck }
715f6c232ceSCornelia Huck 
716f6c232ceSCornelia Huck void HELPER(pcilg)(CPUS390XState *env, uint32_t r1, uint32_t r2)
717f6c232ceSCornelia Huck {
718dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
719f6c232ceSCornelia Huck 
720f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
721f6c232ceSCornelia Huck     pcilg_service_call(cpu, r1, r2, GETPC());
722f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
723f6c232ceSCornelia Huck }
724f6c232ceSCornelia Huck 
725f6c232ceSCornelia Huck void HELPER(pcistg)(CPUS390XState *env, uint32_t r1, uint32_t r2)
726f6c232ceSCornelia Huck {
727dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
728f6c232ceSCornelia Huck 
729f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
730f6c232ceSCornelia Huck     pcistg_service_call(cpu, r1, r2, GETPC());
731f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
732f6c232ceSCornelia Huck }
733f6c232ceSCornelia Huck 
734f6c232ceSCornelia Huck void HELPER(stpcifc)(CPUS390XState *env, uint32_t r1, uint64_t fiba,
735f6c232ceSCornelia Huck                      uint32_t ar)
736f6c232ceSCornelia Huck {
737dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
738f6c232ceSCornelia Huck 
739f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
740f6c232ceSCornelia Huck     stpcifc_service_call(cpu, r1, fiba, ar, GETPC());
741f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
742f6c232ceSCornelia Huck }
743f6c232ceSCornelia Huck 
744f6c232ceSCornelia Huck void HELPER(sic)(CPUS390XState *env, uint64_t r1, uint64_t r3)
745f6c232ceSCornelia Huck {
746f6c232ceSCornelia Huck     int r;
747f6c232ceSCornelia Huck 
748f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
749f6c232ceSCornelia Huck     r = css_do_sic(env, (r3 >> 27) & 0x7, r1 & 0xffff);
750f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
751f6c232ceSCornelia Huck     /* css_do_sic() may actually return a PGM_xxx value to inject */
752f6c232ceSCornelia Huck     if (r) {
7531e36aee6SRichard Henderson         tcg_s390_program_interrupt(env, -r, GETPC());
754f6c232ceSCornelia Huck     }
755f6c232ceSCornelia Huck }
756f6c232ceSCornelia Huck 
757f6c232ceSCornelia Huck void HELPER(rpcit)(CPUS390XState *env, uint32_t r1, uint32_t r2)
758f6c232ceSCornelia Huck {
759dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
760f6c232ceSCornelia Huck 
761f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
762f6c232ceSCornelia Huck     rpcit_service_call(cpu, r1, r2, GETPC());
763f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
764f6c232ceSCornelia Huck }
765f6c232ceSCornelia Huck 
766f6c232ceSCornelia Huck void HELPER(pcistb)(CPUS390XState *env, uint32_t r1, uint32_t r3,
767f6c232ceSCornelia Huck                     uint64_t gaddr, uint32_t ar)
768f6c232ceSCornelia Huck {
769dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
770f6c232ceSCornelia Huck 
771f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
772f6c232ceSCornelia Huck     pcistb_service_call(cpu, r1, r3, gaddr, ar, GETPC());
773f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
774f6c232ceSCornelia Huck }
775f6c232ceSCornelia Huck 
776f6c232ceSCornelia Huck void HELPER(mpcifc)(CPUS390XState *env, uint32_t r1, uint64_t fiba,
777f6c232ceSCornelia Huck                     uint32_t ar)
778f6c232ceSCornelia Huck {
779dc79e928SRichard Henderson     S390CPU *cpu = env_archcpu(env);
780f6c232ceSCornelia Huck 
781f6c232ceSCornelia Huck     qemu_mutex_lock_iothread();
782f6c232ceSCornelia Huck     mpcifc_service_call(cpu, r1, fiba, ar, GETPC());
783f6c232ceSCornelia Huck     qemu_mutex_unlock_iothread();
784f6c232ceSCornelia Huck }
785f6c232ceSCornelia Huck #endif
786