1
2
3
4
5
6
7#include <linux/sched.h>
8#include <linux/sched/task_stack.h>
9#include <linux/kernel.h>
10#include <linux/capability.h>
11#include <linux/errno.h>
12#include <linux/types.h>
13#include <linux/ioport.h>
14#include <linux/smp.h>
15#include <linux/stddef.h>
16#include <linux/slab.h>
17#include <linux/thread_info.h>
18#include <linux/syscalls.h>
19#include <linux/bitmap.h>
20#include <asm/syscalls.h>
21#include <asm/desc.h>
22
23
24
25
26long ksys_ioperm(unsigned long from, unsigned long num, int turn_on)
27{
28 struct thread_struct *t = ¤t->thread;
29 struct tss_struct *tss;
30 unsigned int i, max_long, bytes, bytes_updated;
31
32 if ((from + num <= from) || (from + num > IO_BITMAP_BITS))
33 return -EINVAL;
34 if (turn_on && !capable(CAP_SYS_RAWIO))
35 return -EPERM;
36
37
38
39
40
41
42 if (!t->io_bitmap_ptr) {
43 unsigned long *bitmap = kmalloc(IO_BITMAP_BYTES, GFP_KERNEL);
44
45 if (!bitmap)
46 return -ENOMEM;
47
48 memset(bitmap, 0xff, IO_BITMAP_BYTES);
49 t->io_bitmap_ptr = bitmap;
50 set_thread_flag(TIF_IO_BITMAP);
51
52
53
54
55
56
57
58 preempt_disable();
59 refresh_tss_limit();
60 preempt_enable();
61 }
62
63
64
65
66
67
68
69
70 tss = &per_cpu(cpu_tss_rw, get_cpu());
71
72 if (turn_on)
73 bitmap_clear(t->io_bitmap_ptr, from, num);
74 else
75 bitmap_set(t->io_bitmap_ptr, from, num);
76
77
78
79
80
81 max_long = 0;
82 for (i = 0; i < IO_BITMAP_LONGS; i++)
83 if (t->io_bitmap_ptr[i] != ~0UL)
84 max_long = i;
85
86 bytes = (max_long + 1) * sizeof(unsigned long);
87 bytes_updated = max(bytes, t->io_bitmap_max);
88
89 t->io_bitmap_max = bytes;
90
91
92 memcpy(tss->io_bitmap, t->io_bitmap_ptr, bytes_updated);
93
94 put_cpu();
95
96 return 0;
97}
98
99SYSCALL_DEFINE3(ioperm, unsigned long, from, unsigned long, num, int, turn_on)
100{
101 return ksys_ioperm(from, num, turn_on);
102}
103
104
105
106
107
108
109
110
111
112
113
114SYSCALL_DEFINE1(iopl, unsigned int, level)
115{
116 struct pt_regs *regs = current_pt_regs();
117 struct thread_struct *t = ¤t->thread;
118
119
120
121
122
123 unsigned int old = t->iopl >> X86_EFLAGS_IOPL_BIT;
124
125 if (level > 3)
126 return -EINVAL;
127
128 if (level > old) {
129 if (!capable(CAP_SYS_RAWIO))
130 return -EPERM;
131 }
132 regs->flags = (regs->flags & ~X86_EFLAGS_IOPL) |
133 (level << X86_EFLAGS_IOPL_BIT);
134 t->iopl = level << X86_EFLAGS_IOPL_BIT;
135 set_iopl_mask(t->iopl);
136
137 return 0;
138}
139