vm86_32.c 21.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
 *  Copyright (C) 1994  Linus Torvalds
 *
 *  29 dec 2001 - Fixed oopses caused by unchecked access to the vm86
5
 *                stack - Manfred Spraul <manfred@colorfullife.com>
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
 *
 *  22 mar 2002 - Manfred detected the stackfaults, but didn't handle
 *                them correctly. Now the emulation will be in a
 *                consistent state after stackfaults - Kasper Dupont
 *                <kasperd@daimi.au.dk>
 *
 *  22 mar 2002 - Added missing clear_IF in set_vflags_* Kasper Dupont
 *                <kasperd@daimi.au.dk>
 *
 *  ?? ??? 2002 - Fixed premature returns from handle_vm86_fault
 *                caused by Kasper Dupont's changes - Stas Sergeev
 *
 *   4 apr 2002 - Fixed CHECK_IF_IN_TRAP broken by Stas' changes.
 *                Kasper Dupont <kasperd@daimi.au.dk>
 *
 *   9 apr 2002 - Changed syntax of macros in handle_vm86_fault.
 *                Kasper Dupont <kasperd@daimi.au.dk>
 *
 *   9 apr 2002 - Changed stack access macros to jump to a label
 *                instead of returning to userspace. This simplifies
 *                do_int, and is needed by handle_vm6_fault. Kasper
 *                Dupont <kasperd@daimi.au.dk>
 *
 */

31 32
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

33
#include <linux/capability.h>
L
Linus Torvalds 已提交
34 35
#include <linux/errno.h>
#include <linux/interrupt.h>
36
#include <linux/syscalls.h>
L
Linus Torvalds 已提交
37 38 39 40 41 42 43 44
#include <linux/sched.h>
#include <linux/kernel.h>
#include <linux/signal.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/smp.h>
#include <linux/highmem.h>
#include <linux/ptrace.h>
45
#include <linux/audit.h>
46
#include <linux/stddef.h>
47
#include <linux/slab.h>
L
Linus Torvalds 已提交
48 49 50 51 52

#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/tlbflush.h>
#include <asm/irq.h>
53
#include <asm/traps.h>
B
Brian Gerst 已提交
54
#include <asm/vm86.h>
L
Linus Torvalds 已提交
55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74

/*
 * Known problems:
 *
 * Interrupt handling is not guaranteed:
 * - a real x86 will disable all interrupts for one instruction
 *   after a "mov ss,xx" to make stack handling atomic even without
 *   the 'lss' instruction. We can't guarantee this in v86 mode,
 *   as the next instruction might result in a page fault or similar.
 * - a real x86 will have interrupts disabled for one instruction
 *   past the 'sti' that enables them. We don't bother with all the
 *   details yet.
 *
 * Let's hope these problems do not actually matter for anything.
 */


/*
 * 8- and 16-bit register defines..
 */
75 76 77 78
#define AL(regs)	(((unsigned char *)&((regs)->pt.ax))[0])
#define AH(regs)	(((unsigned char *)&((regs)->pt.ax))[1])
#define IP(regs)	(*(unsigned short *)&((regs)->pt.ip))
#define SP(regs)	(*(unsigned short *)&((regs)->pt.sp))
L
Linus Torvalds 已提交
79 80 81 82

/*
 * virtual flags (16 and 32-bit versions)
 */
83 84
#define VFLAGS	(*(unsigned short *)&(current->thread.vm86->veflags))
#define VEFLAGS	(current->thread.vm86->veflags)
L
Linus Torvalds 已提交
85

86
#define set_flags(X, new, mask) \
L
Linus Torvalds 已提交
87 88 89 90 91
((X) = ((X) & ~(mask)) | ((new) & (mask)))

#define SAFE_MASK	(0xDD5)
#define RETURN_MASK	(0xDFF)

92
void save_v86_state(struct kernel_vm86_regs *regs, int retval)
L
Linus Torvalds 已提交
93 94
{
	struct tss_struct *tss;
95 96
	struct task_struct *tsk = current;
	struct vm86plus_struct __user *user;
97
	struct vm86 *vm86 = current->thread.vm86;
98
	long err = 0;
L
Linus Torvalds 已提交
99 100 101 102 103 104 105 106

	/*
	 * This gets called from entry.S with interrupts disabled, but
	 * from process context. Enable interrupts here, before trying
	 * to access user space.
	 */
	local_irq_enable();

107 108
	if (!vm86 || !vm86->user_vm86) {
		pr_alert("no user_vm86: BAD\n");
L
Linus Torvalds 已提交
109 110
		do_exit(SIGSEGV);
	}
111
	set_flags(regs->pt.flags, VEFLAGS, X86_EFLAGS_VIF | vm86->veflags_mask);
112
	user = vm86->user_vm86;
113

114
	if (!access_ok(VERIFY_WRITE, user, vm86->vm86plus.is_vm86pus ?
115 116
		       sizeof(struct vm86plus_struct) :
		       sizeof(struct vm86_struct))) {
117
		pr_alert("could not access userspace vm86 info\n");
118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138
		do_exit(SIGSEGV);
	}

	put_user_try {
		put_user_ex(regs->pt.bx, &user->regs.ebx);
		put_user_ex(regs->pt.cx, &user->regs.ecx);
		put_user_ex(regs->pt.dx, &user->regs.edx);
		put_user_ex(regs->pt.si, &user->regs.esi);
		put_user_ex(regs->pt.di, &user->regs.edi);
		put_user_ex(regs->pt.bp, &user->regs.ebp);
		put_user_ex(regs->pt.ax, &user->regs.eax);
		put_user_ex(regs->pt.ip, &user->regs.eip);
		put_user_ex(regs->pt.cs, &user->regs.cs);
		put_user_ex(regs->pt.flags, &user->regs.eflags);
		put_user_ex(regs->pt.sp, &user->regs.esp);
		put_user_ex(regs->pt.ss, &user->regs.ss);
		put_user_ex(regs->es, &user->regs.es);
		put_user_ex(regs->ds, &user->regs.ds);
		put_user_ex(regs->fs, &user->regs.fs);
		put_user_ex(regs->gs, &user->regs.gs);

139
		put_user_ex(vm86->screen_bitmap, &user->screen_bitmap);
140 141
	} put_user_catch(err);
	if (err) {
142
		pr_alert("could not access userspace vm86 info\n");
L
Linus Torvalds 已提交
143 144 145
		do_exit(SIGSEGV);
	}

146
	tss = &per_cpu(cpu_tss, get_cpu());
147
	tsk->thread.sp0 = vm86->saved_sp0;
148 149
	tsk->thread.sysenter_cs = __KERNEL_CS;
	load_sp0(tss, &tsk->thread);
150
	vm86->saved_sp0 = 0;
L
Linus Torvalds 已提交
151 152
	put_cpu();

153
	memcpy(&regs->pt, &vm86->regs32, sizeof(struct pt_regs));
154

155
	lazy_load_gs(vm86->regs32.gs);
156

157
	regs->pt.ax = retval;
L
Linus Torvalds 已提交
158 159
}

160
static void mark_screen_rdonly(struct mm_struct *mm)
L
Linus Torvalds 已提交
161 162 163 164
{
	pgd_t *pgd;
	pud_t *pud;
	pmd_t *pmd;
165 166
	pte_t *pte;
	spinlock_t *ptl;
L
Linus Torvalds 已提交
167 168
	int i;

169
	down_write(&mm->mmap_sem);
170
	pgd = pgd_offset(mm, 0xA0000);
L
Linus Torvalds 已提交
171 172 173 174 175 176
	if (pgd_none_or_clear_bad(pgd))
		goto out;
	pud = pud_offset(pgd, 0xA0000);
	if (pud_none_or_clear_bad(pud))
		goto out;
	pmd = pmd_offset(pud, 0xA0000);
177
	split_huge_page_pmd_mm(mm, 0xA0000, pmd);
L
Linus Torvalds 已提交
178 179
	if (pmd_none_or_clear_bad(pmd))
		goto out;
180
	pte = pte_offset_map_lock(mm, pmd, 0xA0000, &ptl);
L
Linus Torvalds 已提交
181 182 183 184 185
	for (i = 0; i < 32; i++) {
		if (pte_present(*pte))
			set_pte(pte, pte_wrprotect(*pte));
		pte++;
	}
186
	pte_unmap_unlock(pte, ptl);
L
Linus Torvalds 已提交
187
out:
188
	up_write(&mm->mmap_sem);
L
Linus Torvalds 已提交
189 190 191 192 193 194
	flush_tlb();
}



static int do_vm86_irq_handling(int subfunction, int irqnumber);
195
static long do_sys_vm86(struct vm86plus_struct __user *user_vm86, bool plus);
L
Linus Torvalds 已提交
196

197
SYSCALL_DEFINE1(vm86old, struct vm86_struct __user *, user_vm86)
L
Linus Torvalds 已提交
198
{
199
	return do_sys_vm86((struct vm86plus_struct __user *) user_vm86, false);
L
Linus Torvalds 已提交
200 201 202
}


203
SYSCALL_DEFINE2(vm86, unsigned long, cmd, unsigned long, arg)
L
Linus Torvalds 已提交
204
{
205
	switch (cmd) {
206 207 208 209
	case VM86_REQUEST_IRQ:
	case VM86_FREE_IRQ:
	case VM86_GET_IRQ_BITS:
	case VM86_GET_AND_RESET_IRQ:
210
		return do_vm86_irq_handling(cmd, (int)arg);
211 212 213 214 215 216 217
	case VM86_PLUS_INSTALL_CHECK:
		/*
		 * NOTE: on old vm86 stuff this will return the error
		 *  from access_ok(), because the subfunction is
		 *  interpreted as (invalid) address to vm86_struct.
		 *  So the installation check works.
		 */
218
		return 0;
L
Linus Torvalds 已提交
219 220 221
	}

	/* we come here only for functions VM86_ENTER, VM86_ENTER_NO_BYPASS */
222
	return do_sys_vm86((struct vm86plus_struct __user *) arg, true);
L
Linus Torvalds 已提交
223 224 225
}


226
static long do_sys_vm86(struct vm86plus_struct __user *user_vm86, bool plus)
L
Linus Torvalds 已提交
227 228
{
	struct tss_struct *tss;
229
	struct task_struct *tsk = current;
230
	struct vm86 *vm86 = tsk->thread.vm86;
231
	struct kernel_vm86_regs vm86regs;
232
	struct pt_regs *regs = current_pt_regs();
233 234
	unsigned long err = 0;

235 236 237 238 239 240
	if (!vm86) {
		if (!(vm86 = kzalloc(sizeof(*vm86), GFP_KERNEL)))
			return -ENOMEM;
		tsk->thread.vm86 = vm86;
	}
	if (vm86->saved_sp0)
241 242
		return -EPERM;

243
	if (!access_ok(VERIFY_READ, user_vm86, plus ?
244 245 246 247
		       sizeof(struct vm86_struct) :
		       sizeof(struct vm86plus_struct)))
		return -EFAULT;

248
	memset(&vm86regs, 0, sizeof(vm86regs));
249 250
	get_user_try {
		unsigned short seg;
251 252 253 254 255 256 257 258 259
		get_user_ex(vm86regs.pt.bx, &user_vm86->regs.ebx);
		get_user_ex(vm86regs.pt.cx, &user_vm86->regs.ecx);
		get_user_ex(vm86regs.pt.dx, &user_vm86->regs.edx);
		get_user_ex(vm86regs.pt.si, &user_vm86->regs.esi);
		get_user_ex(vm86regs.pt.di, &user_vm86->regs.edi);
		get_user_ex(vm86regs.pt.bp, &user_vm86->regs.ebp);
		get_user_ex(vm86regs.pt.ax, &user_vm86->regs.eax);
		get_user_ex(vm86regs.pt.ip, &user_vm86->regs.eip);
		get_user_ex(seg, &user_vm86->regs.cs);
260
		vm86regs.pt.cs = seg;
261 262 263
		get_user_ex(vm86regs.pt.flags, &user_vm86->regs.eflags);
		get_user_ex(vm86regs.pt.sp, &user_vm86->regs.esp);
		get_user_ex(seg, &user_vm86->regs.ss);
264
		vm86regs.pt.ss = seg;
265 266 267 268 269 270 271 272
		get_user_ex(vm86regs.es, &user_vm86->regs.es);
		get_user_ex(vm86regs.ds, &user_vm86->regs.ds);
		get_user_ex(vm86regs.fs, &user_vm86->regs.fs);
		get_user_ex(vm86regs.gs, &user_vm86->regs.gs);

		get_user_ex(vm86->flags, &user_vm86->flags);
		get_user_ex(vm86->screen_bitmap, &user_vm86->screen_bitmap);
		get_user_ex(vm86->cpu_type, &user_vm86->cpu_type);
273 274 275 276
	} get_user_catch(err);
	if (err)
		return err;

277 278
	if (copy_from_user(&vm86->int_revectored,
			   &user_vm86->int_revectored,
279 280
			   sizeof(struct revectored_struct)))
		return -EFAULT;
281 282
	if (copy_from_user(&vm86->int21_revectored,
			   &user_vm86->int21_revectored,
283 284 285
			   sizeof(struct revectored_struct)))
		return -EFAULT;
	if (plus) {
286
		if (copy_from_user(&vm86->vm86plus, &user_vm86->vm86plus,
287 288
				   sizeof(struct vm86plus_info_struct)))
			return -EFAULT;
289 290 291 292
		vm86->vm86plus.is_vm86pus = 1;
	} else
		memset(&vm86->vm86plus, 0,
		       sizeof(struct vm86plus_info_struct));
293 294

	memcpy(&vm86->regs32, regs, sizeof(struct pt_regs));
295
	vm86->user_vm86 = user_vm86;
L
Linus Torvalds 已提交
296 297

/*
298
 * The flags register is also special: we cannot trust that the user
L
Linus Torvalds 已提交
299 300 301
 * has set it up safely, so this makes sure interrupt etc flags are
 * inherited from protected mode.
 */
302 303
	VEFLAGS = vm86regs.pt.flags;
	vm86regs.pt.flags &= SAFE_MASK;
304
	vm86regs.pt.flags |= regs->flags & ~SAFE_MASK;
305
	vm86regs.pt.flags |= X86_VM_MASK;
L
Linus Torvalds 已提交
306

307
	vm86regs.pt.orig_ax = regs->orig_ax;
B
Brian Gerst 已提交
308

309
	switch (vm86->cpu_type) {
310
	case CPU_286:
311
		vm86->veflags_mask = 0;
312 313
		break;
	case CPU_386:
314
		vm86->veflags_mask = X86_EFLAGS_NT | X86_EFLAGS_IOPL;
315 316
		break;
	case CPU_486:
317
		vm86->veflags_mask = X86_EFLAGS_AC | X86_EFLAGS_NT | X86_EFLAGS_IOPL;
318 319
		break;
	default:
320
		vm86->veflags_mask = X86_EFLAGS_ID | X86_EFLAGS_AC | X86_EFLAGS_NT | X86_EFLAGS_IOPL;
321
		break;
L
Linus Torvalds 已提交
322 323 324
	}

/*
325
 * Save old state
L
Linus Torvalds 已提交
326
 */
327
	vm86->saved_sp0 = tsk->thread.sp0;
328
	lazy_save_gs(vm86->regs32.gs);
L
Linus Torvalds 已提交
329

330
	tss = &per_cpu(cpu_tss, get_cpu());
331 332
	/* make room for real-mode segments */
	tsk->thread.sp0 += 16;
L
Linus Torvalds 已提交
333 334
	if (cpu_has_sep)
		tsk->thread.sysenter_cs = 0;
335
	load_sp0(tss, &tsk->thread);
L
Linus Torvalds 已提交
336 337
	put_cpu();

338
	if (vm86->flags & VM86_SCREEN_BITMAP)
339
		mark_screen_rdonly(tsk->mm);
340

341 342 343
	memcpy((struct kernel_vm86_regs *)regs, &vm86regs, sizeof(vm86regs));
	force_iret();
	return regs->ax;
L
Linus Torvalds 已提交
344 345
}

346
static inline void set_IF(struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
347
{
348
	VEFLAGS |= X86_EFLAGS_VIF;
L
Linus Torvalds 已提交
349 350
}

351
static inline void clear_IF(struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
352
{
353
	VEFLAGS &= ~X86_EFLAGS_VIF;
L
Linus Torvalds 已提交
354 355
}

356
static inline void clear_TF(struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
357
{
358
	regs->pt.flags &= ~X86_EFLAGS_TF;
L
Linus Torvalds 已提交
359 360
}

361
static inline void clear_AC(struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
362
{
363
	regs->pt.flags &= ~X86_EFLAGS_AC;
L
Linus Torvalds 已提交
364 365
}

366 367
/*
 * It is correct to call set_IF(regs) from the set_vflags_*
L
Linus Torvalds 已提交
368 369 370
 * functions. However someone forgot to call clear_IF(regs)
 * in the opposite case.
 * After the command sequence CLI PUSHF STI POPF you should
J
Joe Perches 已提交
371
 * end up with interrupts disabled, but you ended up with
L
Linus Torvalds 已提交
372 373 374 375 376 377
 * interrupts enabled.
 *  ( I was testing my own changes, but the only bug I
 *    could find was in a function I had not changed. )
 * [KD]
 */

378
static inline void set_vflags_long(unsigned long flags, struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
379
{
380
	set_flags(VEFLAGS, flags, current->thread.vm86->veflags_mask);
381
	set_flags(regs->pt.flags, flags, SAFE_MASK);
382
	if (flags & X86_EFLAGS_IF)
L
Linus Torvalds 已提交
383 384 385 386 387
		set_IF(regs);
	else
		clear_IF(regs);
}

388
static inline void set_vflags_short(unsigned short flags, struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
389
{
390
	set_flags(VFLAGS, flags, current->thread.vm86->veflags_mask);
391
	set_flags(regs->pt.flags, flags, SAFE_MASK);
392
	if (flags & X86_EFLAGS_IF)
L
Linus Torvalds 已提交
393 394 395 396 397
		set_IF(regs);
	else
		clear_IF(regs);
}

398
static inline unsigned long get_vflags(struct kernel_vm86_regs *regs)
L
Linus Torvalds 已提交
399
{
400
	unsigned long flags = regs->pt.flags & RETURN_MASK;
L
Linus Torvalds 已提交
401

402 403 404
	if (VEFLAGS & X86_EFLAGS_VIF)
		flags |= X86_EFLAGS_IF;
	flags |= X86_EFLAGS_IOPL;
405
	return flags | (VEFLAGS & current->thread.vm86->veflags_mask);
L
Linus Torvalds 已提交
406 407
}

408
static inline int is_revectored(int nr, struct revectored_struct *bitmap)
L
Linus Torvalds 已提交
409 410 411
{
	__asm__ __volatile__("btl %2,%1\n\tsbbl %0,%0"
		:"=r" (nr)
412
		:"m" (*bitmap), "r" (nr));
L
Linus Torvalds 已提交
413 414 415 416 417 418 419 420 421 422 423
	return nr;
}

#define val_byte(val, n) (((__u8 *)&val)[n])

#define pushb(base, ptr, val, err_label) \
	do { \
		__u8 __val = val; \
		ptr--; \
		if (put_user(__val, base + ptr) < 0) \
			goto err_label; \
424
	} while (0)
L
Linus Torvalds 已提交
425 426 427 428 429 430 431 432 433 434

#define pushw(base, ptr, val, err_label) \
	do { \
		__u16 __val = val; \
		ptr--; \
		if (put_user(val_byte(__val, 1), base + ptr) < 0) \
			goto err_label; \
		ptr--; \
		if (put_user(val_byte(__val, 0), base + ptr) < 0) \
			goto err_label; \
435
	} while (0)
L
Linus Torvalds 已提交
436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451

#define pushl(base, ptr, val, err_label) \
	do { \
		__u32 __val = val; \
		ptr--; \
		if (put_user(val_byte(__val, 3), base + ptr) < 0) \
			goto err_label; \
		ptr--; \
		if (put_user(val_byte(__val, 2), base + ptr) < 0) \
			goto err_label; \
		ptr--; \
		if (put_user(val_byte(__val, 1), base + ptr) < 0) \
			goto err_label; \
		ptr--; \
		if (put_user(val_byte(__val, 0), base + ptr) < 0) \
			goto err_label; \
452
	} while (0)
L
Linus Torvalds 已提交
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498

#define popb(base, ptr, err_label) \
	({ \
		__u8 __res; \
		if (get_user(__res, base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		__res; \
	})

#define popw(base, ptr, err_label) \
	({ \
		__u16 __res; \
		if (get_user(val_byte(__res, 0), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		if (get_user(val_byte(__res, 1), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		__res; \
	})

#define popl(base, ptr, err_label) \
	({ \
		__u32 __res; \
		if (get_user(val_byte(__res, 0), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		if (get_user(val_byte(__res, 1), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		if (get_user(val_byte(__res, 2), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		if (get_user(val_byte(__res, 3), base + ptr) < 0) \
			goto err_label; \
		ptr++; \
		__res; \
	})

/* There are so many possible reasons for this function to return
 * VM86_INTx, so adding another doesn't bother me. We can expect
 * userspace programs to be able to handle it. (Getting a problem
 * in userspace is always better than an Oops anyway.) [KD]
 */
static void do_int(struct kernel_vm86_regs *regs, int i,
499
    unsigned char __user *ssp, unsigned short sp)
L
Linus Torvalds 已提交
500 501 502
{
	unsigned long __user *intr_ptr;
	unsigned long segoffs;
503
	struct vm86 *vm86 = current->thread.vm86;
L
Linus Torvalds 已提交
504

505
	if (regs->pt.cs == BIOSSEG)
L
Linus Torvalds 已提交
506
		goto cannot_handle;
507
	if (is_revectored(i, &vm86->int_revectored))
L
Linus Torvalds 已提交
508
		goto cannot_handle;
509
	if (i == 0x21 && is_revectored(AH(regs), &vm86->int21_revectored))
L
Linus Torvalds 已提交
510 511 512 513 514 515 516
		goto cannot_handle;
	intr_ptr = (unsigned long __user *) (i << 2);
	if (get_user(segoffs, intr_ptr))
		goto cannot_handle;
	if ((segoffs >> 16) == BIOSSEG)
		goto cannot_handle;
	pushw(ssp, sp, get_vflags(regs), cannot_handle);
517
	pushw(ssp, sp, regs->pt.cs, cannot_handle);
L
Linus Torvalds 已提交
518
	pushw(ssp, sp, IP(regs), cannot_handle);
519
	regs->pt.cs = segoffs >> 16;
L
Linus Torvalds 已提交
520 521 522 523 524 525 526 527
	SP(regs) -= 6;
	IP(regs) = segoffs & 0xffff;
	clear_TF(regs);
	clear_IF(regs);
	clear_AC(regs);
	return;

cannot_handle:
528
	save_v86_state(regs, VM86_INTx + (i << 8));
L
Linus Torvalds 已提交
529 530
}

531
int handle_vm86_trap(struct kernel_vm86_regs *regs, long error_code, int trapno)
L
Linus Torvalds 已提交
532
{
533 534 535
	struct vm86 *vm86 = current->thread.vm86;

	if (vm86->vm86plus.is_vm86pus) {
536
		if ((trapno == 3) || (trapno == 1)) {
537
			save_v86_state(regs, VM86_TRAP + (trapno << 8));
538 539
			return 0;
		}
540
		do_int(regs, trapno, (unsigned char __user *) (regs->pt.ss << 4), SP(regs));
L
Linus Torvalds 已提交
541 542
		return 0;
	}
543
	if (trapno != 1)
L
Linus Torvalds 已提交
544
		return 1; /* we let this handle by the calling routine */
545
	current->thread.trap_nr = trapno;
L
Linus Torvalds 已提交
546
	current->thread.error_code = error_code;
R
Roland McGrath 已提交
547
	force_sig(SIGTRAP, current);
L
Linus Torvalds 已提交
548 549 550
	return 0;
}

551
void handle_vm86_fault(struct kernel_vm86_regs *regs, long error_code)
L
Linus Torvalds 已提交
552 553 554 555
{
	unsigned char opcode;
	unsigned char __user *csp;
	unsigned char __user *ssp;
556
	unsigned short ip, sp, orig_flags;
L
Linus Torvalds 已提交
557
	int data32, pref_done;
558
	struct vm86plus_info_struct *vmpi = &current->thread.vm86->vm86plus;
L
Linus Torvalds 已提交
559 560

#define CHECK_IF_IN_TRAP \
561
	if (vmpi->vm86dbg_active && vmpi->vm86dbg_TFpendig) \
562
		newflags |= X86_EFLAGS_TF
L
Linus Torvalds 已提交
563

564
	orig_flags = *(unsigned short *)&regs->pt.flags;
565

566 567
	csp = (unsigned char __user *) (regs->pt.cs << 4);
	ssp = (unsigned char __user *) (regs->pt.ss << 4);
L
Linus Torvalds 已提交
568 569 570 571 572 573 574
	sp = SP(regs);
	ip = IP(regs);

	data32 = 0;
	pref_done = 0;
	do {
		switch (opcode = popb(csp, ip, simulate_sigsegv)) {
575 576 577 578 579 580 581 582 583 584 585
		case 0x66:      /* 32-bit data */     data32 = 1; break;
		case 0x67:      /* 32-bit address */  break;
		case 0x2e:      /* CS */              break;
		case 0x3e:      /* DS */              break;
		case 0x26:      /* ES */              break;
		case 0x36:      /* SS */              break;
		case 0x65:      /* GS */              break;
		case 0x64:      /* FS */              break;
		case 0xf2:      /* repnz */       break;
		case 0xf3:      /* rep */             break;
		default: pref_done = 1;
L
Linus Torvalds 已提交
586 587 588 589 590 591 592 593 594 595 596 597 598 599 600
		}
	} while (!pref_done);

	switch (opcode) {

	/* pushf */
	case 0x9c:
		if (data32) {
			pushl(ssp, sp, get_vflags(regs), simulate_sigsegv);
			SP(regs) -= 4;
		} else {
			pushw(ssp, sp, get_vflags(regs), simulate_sigsegv);
			SP(regs) -= 2;
		}
		IP(regs) = ip;
601
		goto vm86_fault_return;
L
Linus Torvalds 已提交
602 603 604 605 606 607

	/* popf */
	case 0x9d:
		{
		unsigned long newflags;
		if (data32) {
608
			newflags = popl(ssp, sp, simulate_sigsegv);
L
Linus Torvalds 已提交
609 610 611 612 613 614 615
			SP(regs) += 4;
		} else {
			newflags = popw(ssp, sp, simulate_sigsegv);
			SP(regs) += 2;
		}
		IP(regs) = ip;
		CHECK_IF_IN_TRAP;
616
		if (data32)
L
Linus Torvalds 已提交
617
			set_vflags_long(newflags, regs);
618
		else
L
Linus Torvalds 已提交
619
			set_vflags_short(newflags, regs);
620

621
		goto check_vip;
L
Linus Torvalds 已提交
622 623 624 625
		}

	/* int xx */
	case 0xcd: {
626
		int intno = popb(csp, ip, simulate_sigsegv);
L
Linus Torvalds 已提交
627
		IP(regs) = ip;
628
		if (vmpi->vm86dbg_active) {
629 630 631 632
			if ((1 << (intno & 7)) & vmpi->vm86dbg_intxxtab[intno >> 3]) {
				save_v86_state(regs, VM86_INTx + (intno << 8));
				return;
			}
L
Linus Torvalds 已提交
633 634 635 636 637 638 639 640 641 642 643 644
		}
		do_int(regs, intno, ssp, sp);
		return;
	}

	/* iret */
	case 0xcf:
		{
		unsigned long newip;
		unsigned long newcs;
		unsigned long newflags;
		if (data32) {
645 646 647
			newip = popl(ssp, sp, simulate_sigsegv);
			newcs = popl(ssp, sp, simulate_sigsegv);
			newflags = popl(ssp, sp, simulate_sigsegv);
L
Linus Torvalds 已提交
648 649 650 651 652 653 654 655
			SP(regs) += 12;
		} else {
			newip = popw(ssp, sp, simulate_sigsegv);
			newcs = popw(ssp, sp, simulate_sigsegv);
			newflags = popw(ssp, sp, simulate_sigsegv);
			SP(regs) += 6;
		}
		IP(regs) = newip;
656
		regs->pt.cs = newcs;
L
Linus Torvalds 已提交
657 658 659 660 661 662
		CHECK_IF_IN_TRAP;
		if (data32) {
			set_vflags_long(newflags, regs);
		} else {
			set_vflags_short(newflags, regs);
		}
663
		goto check_vip;
L
Linus Torvalds 已提交
664 665 666 667 668 669
		}

	/* cli */
	case 0xfa:
		IP(regs) = ip;
		clear_IF(regs);
670
		goto vm86_fault_return;
L
Linus Torvalds 已提交
671 672 673 674 675 676 677 678 679 680 681

	/* sti */
	/*
	 * Damn. This is incorrect: the 'sti' instruction should actually
	 * enable interrupts after the /next/ instruction. Not good.
	 *
	 * Probably needs some horsing around with the TF flag. Aiee..
	 */
	case 0xfb:
		IP(regs) = ip;
		set_IF(regs);
682
		goto check_vip;
L
Linus Torvalds 已提交
683 684

	default:
685
		save_v86_state(regs, VM86_UNKNOWN);
L
Linus Torvalds 已提交
686 687 688 689
	}

	return;

690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
check_vip:
	if (VEFLAGS & X86_EFLAGS_VIP) {
		save_v86_state(regs, VM86_STI);
		return;
	}

vm86_fault_return:
	if (vmpi->force_return_for_pic  && (VEFLAGS & (X86_EFLAGS_IF | X86_EFLAGS_VIF))) {
		save_v86_state(regs, VM86_PICRETURN);
		return;
	}
	if (orig_flags & X86_EFLAGS_TF)
		handle_vm86_trap(regs, 0, X86_TRAP_DB);
	return;

L
Linus Torvalds 已提交
705 706 707 708 709 710 711 712 713 714 715
simulate_sigsegv:
	/* FIXME: After a long discussion with Stas we finally
	 *        agreed, that this is wrong. Here we should
	 *        really send a SIGSEGV to the user program.
	 *        But how do we create the correct context? We
	 *        are inside a general protection fault handler
	 *        and has just returned from a page fault handler.
	 *        The correct context for the signal handler
	 *        should be a mixture of the two, but how do we
	 *        get the information? [KD]
	 */
716
	save_v86_state(regs, VM86_UNKNOWN);
L
Linus Torvalds 已提交
717 718 719 720 721 722 723 724 725 726 727 728 729 730
}

/* ---------------- vm86 special IRQ passing stuff ----------------- */

#define VM86_IRQNAME		"vm86irq"

static struct vm86_irqs {
	struct task_struct *tsk;
	int sig;
} vm86_irqs[16];

static DEFINE_SPINLOCK(irqbits_lock);
static int irqbits;

731
#define ALLOWED_SIGS (1 /* 0 = don't send a signal */ \
L
Linus Torvalds 已提交
732
	| (1 << SIGUSR1) | (1 << SIGUSR2) | (1 << SIGIO)  | (1 << SIGURG) \
733 734
	| (1 << SIGUNUSED))

735
static irqreturn_t irq_handler(int intno, void *dev_id)
L
Linus Torvalds 已提交
736 737 738 739
{
	int irq_bit;
	unsigned long flags;

740
	spin_lock_irqsave(&irqbits_lock, flags);
L
Linus Torvalds 已提交
741
	irq_bit = 1 << intno;
742
	if ((irqbits & irq_bit) || !vm86_irqs[intno].tsk)
L
Linus Torvalds 已提交
743 744 745 746 747 748 749 750
		goto out;
	irqbits |= irq_bit;
	if (vm86_irqs[intno].sig)
		send_sig(vm86_irqs[intno].sig, vm86_irqs[intno].tsk, 1);
	/*
	 * IRQ will be re-enabled when user asks for the irq (whether
	 * polling or as a result of the signal)
	 */
751 752
	disable_irq_nosync(intno);
	spin_unlock_irqrestore(&irqbits_lock, flags);
L
Linus Torvalds 已提交
753 754 755
	return IRQ_HANDLED;

out:
756
	spin_unlock_irqrestore(&irqbits_lock, flags);
L
Linus Torvalds 已提交
757 758 759 760 761 762 763 764 765 766
	return IRQ_NONE;
}

static inline void free_vm86_irq(int irqnumber)
{
	unsigned long flags;

	free_irq(irqnumber, NULL);
	vm86_irqs[irqnumber].tsk = NULL;

767
	spin_lock_irqsave(&irqbits_lock, flags);
L
Linus Torvalds 已提交
768
	irqbits &= ~(1 << irqnumber);
769
	spin_unlock_irqrestore(&irqbits_lock, flags);
L
Linus Torvalds 已提交
770 771 772 773 774 775 776 777 778 779 780 781 782 783
}

void release_vm86_irqs(struct task_struct *task)
{
	int i;
	for (i = FIRST_VM86_IRQ ; i <= LAST_VM86_IRQ; i++)
	    if (vm86_irqs[i].tsk == task)
		free_vm86_irq(i);
}

static inline int get_and_reset_irq(int irqnumber)
{
	int bit;
	unsigned long flags;
784
	int ret = 0;
785

L
Linus Torvalds 已提交
786 787
	if (invalid_vm86_irq(irqnumber)) return 0;
	if (vm86_irqs[irqnumber].tsk != current) return 0;
788
	spin_lock_irqsave(&irqbits_lock, flags);
L
Linus Torvalds 已提交
789 790
	bit = irqbits & (1 << irqnumber);
	irqbits &= ~bit;
791 792 793 794 795
	if (bit) {
		enable_irq(irqnumber);
		ret = 1;
	}

796
	spin_unlock_irqrestore(&irqbits_lock, flags);
797
	return ret;
L
Linus Torvalds 已提交
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834
}


static int do_vm86_irq_handling(int subfunction, int irqnumber)
{
	int ret;
	switch (subfunction) {
		case VM86_GET_AND_RESET_IRQ: {
			return get_and_reset_irq(irqnumber);
		}
		case VM86_GET_IRQ_BITS: {
			return irqbits;
		}
		case VM86_REQUEST_IRQ: {
			int sig = irqnumber >> 8;
			int irq = irqnumber & 255;
			if (!capable(CAP_SYS_ADMIN)) return -EPERM;
			if (!((1 << sig) & ALLOWED_SIGS)) return -EPERM;
			if (invalid_vm86_irq(irq)) return -EPERM;
			if (vm86_irqs[irq].tsk) return -EPERM;
			ret = request_irq(irq, &irq_handler, 0, VM86_IRQNAME, NULL);
			if (ret) return ret;
			vm86_irqs[irq].sig = sig;
			vm86_irqs[irq].tsk = current;
			return irq;
		}
		case  VM86_FREE_IRQ: {
			if (invalid_vm86_irq(irqnumber)) return -EPERM;
			if (!vm86_irqs[irqnumber].tsk) return 0;
			if (vm86_irqs[irqnumber].tsk != current) return -EPERM;
			free_vm86_irq(irqnumber);
			return 0;
		}
	}
	return -EINVAL;
}