2 * sigp.c - handlinge interprocessor communication
4 * Copyright IBM Corp. 2008
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License (version 2 only)
8 * as published by the Free Software Foundation.
10 * Author(s): Carsten Otte <cotte@de.ibm.com>
11 * Christian Borntraeger <borntraeger@de.ibm.com>
14 #include <linux/kvm.h>
15 #include <linux/kvm_host.h>
19 /* sigp order codes */
20 #define SIGP_SENSE 0x01
21 #define SIGP_EXTERNAL_CALL 0x02
22 #define SIGP_EMERGENCY 0x03
23 #define SIGP_START 0x04
24 #define SIGP_STOP 0x05
25 #define SIGP_RESTART 0x06
26 #define SIGP_STOP_STORE_STATUS 0x09
27 #define SIGP_INITIAL_CPU_RESET 0x0b
28 #define SIGP_CPU_RESET 0x0c
29 #define SIGP_SET_PREFIX 0x0d
30 #define SIGP_STORE_STATUS_ADDR 0x0e
31 #define SIGP_SET_ARCH 0x12
34 #define SIGP_STAT_EQUIPMENT_CHECK 0x80000000UL
35 #define SIGP_STAT_INCORRECT_STATE 0x00000200UL
36 #define SIGP_STAT_INVALID_PARAMETER 0x00000100UL
37 #define SIGP_STAT_EXT_CALL_PENDING 0x00000080UL
38 #define SIGP_STAT_STOPPED 0x00000040UL
39 #define SIGP_STAT_OPERATOR_INTERV 0x00000020UL
40 #define SIGP_STAT_CHECK_STOP 0x00000010UL
41 #define SIGP_STAT_INOPERATIVE 0x00000004UL
42 #define SIGP_STAT_INVALID_ORDER 0x00000002UL
43 #define SIGP_STAT_RECEIVER_CHECK 0x00000001UL
46 static int __sigp_sense(struct kvm_vcpu
*vcpu
, u16 cpu_addr
,
49 struct kvm_s390_float_interrupt
*fi
= &vcpu
->kvm
->arch
.float_int
;
52 if (cpu_addr
>= KVM_MAX_VCPUS
)
53 return 3; /* not operational */
56 if (fi
->local_int
[cpu_addr
] == NULL
)
57 rc
= 3; /* not operational */
58 else if (atomic_read(fi
->local_int
[cpu_addr
]->cpuflags
)
60 *reg
&= 0xffffffff00000000UL
;
61 rc
= 1; /* status stored */
63 *reg
&= 0xffffffff00000000UL
;
64 *reg
|= SIGP_STAT_STOPPED
;
65 rc
= 1; /* status stored */
67 spin_unlock(&fi
->lock
);
69 VCPU_EVENT(vcpu
, 4, "sensed status of cpu %x rc %x", cpu_addr
, rc
);
73 static int __sigp_emergency(struct kvm_vcpu
*vcpu
, u16 cpu_addr
)
75 struct kvm_s390_float_interrupt
*fi
= &vcpu
->kvm
->arch
.float_int
;
76 struct kvm_s390_local_interrupt
*li
;
77 struct kvm_s390_interrupt_info
*inti
;
80 if (cpu_addr
>= KVM_MAX_VCPUS
)
81 return 3; /* not operational */
83 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
87 inti
->type
= KVM_S390_INT_EMERGENCY
;
90 li
= fi
->local_int
[cpu_addr
];
92 rc
= 3; /* not operational */
96 spin_lock_bh(&li
->lock
);
97 list_add_tail(&inti
->list
, &li
->list
);
98 atomic_set(&li
->active
, 1);
99 atomic_set_mask(CPUSTAT_EXT_INT
, li
->cpuflags
);
100 if (waitqueue_active(&li
->wq
))
101 wake_up_interruptible(&li
->wq
);
102 spin_unlock_bh(&li
->lock
);
103 rc
= 0; /* order accepted */
105 spin_unlock(&fi
->lock
);
106 VCPU_EVENT(vcpu
, 4, "sent sigp emerg to cpu %x", cpu_addr
);
110 static int __sigp_stop(struct kvm_vcpu
*vcpu
, u16 cpu_addr
, int store
)
112 struct kvm_s390_float_interrupt
*fi
= &vcpu
->kvm
->arch
.float_int
;
113 struct kvm_s390_local_interrupt
*li
;
114 struct kvm_s390_interrupt_info
*inti
;
117 if (cpu_addr
>= KVM_MAX_VCPUS
)
118 return 3; /* not operational */
120 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
124 inti
->type
= KVM_S390_SIGP_STOP
;
126 spin_lock(&fi
->lock
);
127 li
= fi
->local_int
[cpu_addr
];
129 rc
= 3; /* not operational */
133 spin_lock_bh(&li
->lock
);
134 list_add_tail(&inti
->list
, &li
->list
);
135 atomic_set(&li
->active
, 1);
136 atomic_set_mask(CPUSTAT_STOP_INT
, li
->cpuflags
);
138 li
->action_bits
|= ACTION_STORE_ON_STOP
;
139 li
->action_bits
|= ACTION_STOP_ON_STOP
;
140 if (waitqueue_active(&li
->wq
))
141 wake_up_interruptible(&li
->wq
);
142 spin_unlock_bh(&li
->lock
);
143 rc
= 0; /* order accepted */
145 spin_unlock(&fi
->lock
);
146 VCPU_EVENT(vcpu
, 4, "sent sigp stop to cpu %x", cpu_addr
);
150 static int __sigp_set_arch(struct kvm_vcpu
*vcpu
, u32 parameter
)
154 switch (parameter
& 0xff) {
156 rc
= 3; /* not operational */
160 rc
= 0; /* order accepted */
168 static int __sigp_set_prefix(struct kvm_vcpu
*vcpu
, u16 cpu_addr
, u32 address
,
171 struct kvm_s390_float_interrupt
*fi
= &vcpu
->kvm
->arch
.float_int
;
172 struct kvm_s390_local_interrupt
*li
= NULL
;
173 struct kvm_s390_interrupt_info
*inti
;
177 /* make sure that the new value is valid memory */
178 address
= address
& 0x7fffe000u
;
179 if ((copy_from_guest(vcpu
, &tmp
,
180 (u64
) (address
+ vcpu
->kvm
->arch
.guest_origin
) , 1)) ||
181 (copy_from_guest(vcpu
, &tmp
, (u64
) (address
+
182 vcpu
->kvm
->arch
.guest_origin
+ PAGE_SIZE
), 1))) {
183 *reg
|= SIGP_STAT_INVALID_PARAMETER
;
184 return 1; /* invalid parameter */
187 inti
= kzalloc(sizeof(*inti
), GFP_KERNEL
);
191 spin_lock(&fi
->lock
);
192 if (cpu_addr
< KVM_MAX_VCPUS
)
193 li
= fi
->local_int
[cpu_addr
];
196 rc
= 1; /* incorrect state */
197 *reg
&= SIGP_STAT_INCORRECT_STATE
;
202 spin_lock_bh(&li
->lock
);
203 /* cpu must be in stopped state */
204 if (atomic_read(li
->cpuflags
) & CPUSTAT_RUNNING
) {
205 rc
= 1; /* incorrect state */
206 *reg
&= SIGP_STAT_INCORRECT_STATE
;
211 inti
->type
= KVM_S390_SIGP_SET_PREFIX
;
212 inti
->prefix
.address
= address
;
214 list_add_tail(&inti
->list
, &li
->list
);
215 atomic_set(&li
->active
, 1);
216 if (waitqueue_active(&li
->wq
))
217 wake_up_interruptible(&li
->wq
);
218 rc
= 0; /* order accepted */
220 VCPU_EVENT(vcpu
, 4, "set prefix of cpu %02x to %x", cpu_addr
, address
);
222 spin_unlock_bh(&li
->lock
);
224 spin_unlock(&fi
->lock
);
228 int kvm_s390_handle_sigp(struct kvm_vcpu
*vcpu
)
230 int r1
= (vcpu
->arch
.sie_block
->ipa
& 0x00f0) >> 4;
231 int r3
= vcpu
->arch
.sie_block
->ipa
& 0x000f;
232 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
233 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
235 u16 cpu_addr
= vcpu
->arch
.guest_gprs
[r3
];
239 /* sigp in userspace can exit */
240 if (vcpu
->arch
.sie_block
->gpsw
.mask
& PSW_MASK_PSTATE
)
241 return kvm_s390_inject_program_int(vcpu
,
242 PGM_PRIVILEGED_OPERATION
);
246 order_code
+= vcpu
->arch
.guest_gprs
[base2
];
249 parameter
= vcpu
->arch
.guest_gprs
[r1
];
251 parameter
= vcpu
->arch
.guest_gprs
[r1
+ 1];
253 switch (order_code
) {
255 vcpu
->stat
.instruction_sigp_sense
++;
256 rc
= __sigp_sense(vcpu
, cpu_addr
,
257 &vcpu
->arch
.guest_gprs
[r1
]);
260 vcpu
->stat
.instruction_sigp_emergency
++;
261 rc
= __sigp_emergency(vcpu
, cpu_addr
);
264 vcpu
->stat
.instruction_sigp_stop
++;
265 rc
= __sigp_stop(vcpu
, cpu_addr
, 0);
267 case SIGP_STOP_STORE_STATUS
:
268 vcpu
->stat
.instruction_sigp_stop
++;
269 rc
= __sigp_stop(vcpu
, cpu_addr
, 1);
272 vcpu
->stat
.instruction_sigp_arch
++;
273 rc
= __sigp_set_arch(vcpu
, parameter
);
275 case SIGP_SET_PREFIX
:
276 vcpu
->stat
.instruction_sigp_prefix
++;
277 rc
= __sigp_set_prefix(vcpu
, cpu_addr
, parameter
,
278 &vcpu
->arch
.guest_gprs
[r1
]);
281 vcpu
->stat
.instruction_sigp_restart
++;
282 /* user space must know about restart */
290 vcpu
->arch
.sie_block
->gpsw
.mask
&= ~(3ul << 44);
291 vcpu
->arch
.sie_block
->gpsw
.mask
|= (rc
& 3ul) << 44;