2 * priv.c - handling privileged instructions
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/errno.h>
16 #include <asm/current.h>
17 #include <asm/debug.h>
18 #include <asm/ebcdic.h>
19 #include <asm/sysinfo.h>
23 static int handle_set_prefix(struct kvm_vcpu
*vcpu
)
25 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
26 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
31 vcpu
->stat
.instruction_spx
++;
35 operand2
+= vcpu
->arch
.guest_gprs
[base2
];
37 /* must be word boundary */
39 kvm_s390_inject_program_int(vcpu
, PGM_SPECIFICATION
);
44 if (get_guest_u32(vcpu
, operand2
, &address
)) {
45 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
49 address
= address
& 0x7fffe000u
;
51 /* make sure that the new value is valid memory */
52 if (copy_from_guest_absolute(vcpu
, &tmp
, address
, 1) ||
53 (copy_from_guest_absolute(vcpu
, &tmp
, address
+ PAGE_SIZE
, 1))) {
54 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
58 vcpu
->arch
.sie_block
->prefix
= address
;
59 vcpu
->arch
.sie_block
->ihcpu
= 0xffff;
61 VCPU_EVENT(vcpu
, 5, "setting prefix to %x", address
);
66 static int handle_store_prefix(struct kvm_vcpu
*vcpu
)
68 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
69 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
73 vcpu
->stat
.instruction_stpx
++;
76 operand2
+= vcpu
->arch
.guest_gprs
[base2
];
78 /* must be word boundary */
80 kvm_s390_inject_program_int(vcpu
, PGM_SPECIFICATION
);
84 address
= vcpu
->arch
.sie_block
->prefix
;
85 address
= address
& 0x7fffe000u
;
88 if (put_guest_u32(vcpu
, operand2
, address
)) {
89 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
93 VCPU_EVENT(vcpu
, 5, "storing prefix to %x", address
);
98 static int handle_store_cpu_address(struct kvm_vcpu
*vcpu
)
100 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
101 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
105 vcpu
->stat
.instruction_stap
++;
108 useraddr
+= vcpu
->arch
.guest_gprs
[base2
];
111 kvm_s390_inject_program_int(vcpu
, PGM_SPECIFICATION
);
115 rc
= put_guest_u16(vcpu
, useraddr
, vcpu
->vcpu_id
);
117 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
121 VCPU_EVENT(vcpu
, 5, "storing cpu address to %lx", useraddr
);
126 static int handle_skey(struct kvm_vcpu
*vcpu
)
128 vcpu
->stat
.instruction_storage_key
++;
129 vcpu
->arch
.sie_block
->gpsw
.addr
-= 4;
130 VCPU_EVENT(vcpu
, 4, "%s", "retrying storage key operation");
134 static int handle_stsch(struct kvm_vcpu
*vcpu
)
136 vcpu
->stat
.instruction_stsch
++;
137 VCPU_EVENT(vcpu
, 4, "%s", "store subchannel - CC3");
138 /* condition code 3 */
139 vcpu
->arch
.sie_block
->gpsw
.mask
&= ~(3ul << 44);
140 vcpu
->arch
.sie_block
->gpsw
.mask
|= (3 & 3ul) << 44;
144 static int handle_chsc(struct kvm_vcpu
*vcpu
)
146 vcpu
->stat
.instruction_chsc
++;
147 VCPU_EVENT(vcpu
, 4, "%s", "channel subsystem call - CC3");
148 /* condition code 3 */
149 vcpu
->arch
.sie_block
->gpsw
.mask
&= ~(3ul << 44);
150 vcpu
->arch
.sie_block
->gpsw
.mask
|= (3 & 3ul) << 44;
154 static int handle_stfl(struct kvm_vcpu
*vcpu
)
156 unsigned int facility_list
= stfl();
159 vcpu
->stat
.instruction_stfl
++;
160 facility_list
&= ~(1UL<<24); /* no stfle */
162 rc
= copy_to_guest(vcpu
, offsetof(struct _lowcore
, stfl_fac_list
),
163 &facility_list
, sizeof(facility_list
));
165 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
167 VCPU_EVENT(vcpu
, 5, "store facility list value %x",
172 static int handle_stidp(struct kvm_vcpu
*vcpu
)
174 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
175 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
179 vcpu
->stat
.instruction_stidp
++;
182 operand2
+= vcpu
->arch
.guest_gprs
[base2
];
185 kvm_s390_inject_program_int(vcpu
, PGM_SPECIFICATION
);
189 rc
= put_guest_u64(vcpu
, operand2
, vcpu
->arch
.stidp_data
);
191 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
195 VCPU_EVENT(vcpu
, 5, "%s", "store cpu id");
200 static void handle_stsi_3_2_2(struct kvm_vcpu
*vcpu
, struct sysinfo_3_2_2
*mem
)
202 struct float_interrupt
*fi
= &vcpu
->kvm
->arch
.float_int
;
206 spin_lock_bh(&fi
->lock
);
207 for (n
= 0; n
< KVM_MAX_VCPUS
; n
++)
208 if (fi
->local_int
[n
])
210 spin_unlock_bh(&fi
->lock
);
212 /* deal with other level 3 hypervisors */
213 if (stsi(mem
, 3, 2, 2) == -ENOSYS
)
217 for (n
= mem
->count
- 1; n
> 0 ; n
--)
218 memcpy(&mem
->vm
[n
], &mem
->vm
[n
- 1], sizeof(mem
->vm
[0]));
220 mem
->vm
[0].cpus_total
= cpus
;
221 mem
->vm
[0].cpus_configured
= cpus
;
222 mem
->vm
[0].cpus_standby
= 0;
223 mem
->vm
[0].cpus_reserved
= 0;
224 mem
->vm
[0].caf
= 1000;
225 memcpy(mem
->vm
[0].name
, "KVMguest", 8);
226 ASCEBC(mem
->vm
[0].name
, 8);
227 memcpy(mem
->vm
[0].cpi
, "KVM/Linux ", 16);
228 ASCEBC(mem
->vm
[0].cpi
, 16);
231 static int handle_stsi(struct kvm_vcpu
*vcpu
)
233 int fc
= (vcpu
->arch
.guest_gprs
[0] & 0xf0000000) >> 28;
234 int sel1
= vcpu
->arch
.guest_gprs
[0] & 0xff;
235 int sel2
= vcpu
->arch
.guest_gprs
[1] & 0xffff;
236 int base2
= vcpu
->arch
.sie_block
->ipb
>> 28;
237 int disp2
= ((vcpu
->arch
.sie_block
->ipb
& 0x0fff0000) >> 16);
241 vcpu
->stat
.instruction_stsi
++;
242 VCPU_EVENT(vcpu
, 4, "stsi: fc: %x sel1: %x sel2: %x", fc
, sel1
, sel2
);
246 operand2
+= vcpu
->arch
.guest_gprs
[base2
];
248 if (operand2
& 0xfff && fc
> 0)
249 return kvm_s390_inject_program_int(vcpu
, PGM_SPECIFICATION
);
253 vcpu
->arch
.guest_gprs
[0] = 3 << 28;
254 vcpu
->arch
.sie_block
->gpsw
.mask
&= ~(3ul << 44);
256 case 1: /* same handling for 1 and 2 */
258 mem
= get_zeroed_page(GFP_KERNEL
);
261 if (stsi((void *) mem
, fc
, sel1
, sel2
) == -ENOSYS
)
265 if (sel1
!= 2 || sel2
!= 2)
267 mem
= get_zeroed_page(GFP_KERNEL
);
270 handle_stsi_3_2_2(vcpu
, (void *) mem
);
276 if (copy_to_guest_absolute(vcpu
, operand2
, (void *) mem
, PAGE_SIZE
)) {
277 kvm_s390_inject_program_int(vcpu
, PGM_ADDRESSING
);
281 vcpu
->arch
.sie_block
->gpsw
.mask
&= ~(3ul << 44);
282 vcpu
->arch
.guest_gprs
[0] = 0;
287 /* condition code 3 */
288 vcpu
->arch
.sie_block
->gpsw
.mask
|= 3ul << 44;
292 static intercept_handler_t priv_handlers
[256] = {
293 [0x02] = handle_stidp
,
294 [0x10] = handle_set_prefix
,
295 [0x11] = handle_store_prefix
,
296 [0x12] = handle_store_cpu_address
,
297 [0x29] = handle_skey
,
298 [0x2a] = handle_skey
,
299 [0x2b] = handle_skey
,
300 [0x34] = handle_stsch
,
301 [0x5f] = handle_chsc
,
302 [0x7d] = handle_stsi
,
303 [0xb1] = handle_stfl
,
306 int kvm_s390_handle_priv(struct kvm_vcpu
*vcpu
)
308 intercept_handler_t handler
;
310 handler
= priv_handlers
[vcpu
->arch
.sie_block
->ipa
& 0x00ff];
312 return handler(vcpu
);