1 /*
2  * Copyright (c) 1991, 1992 Paul Kranenburg <pk@cs.few.eur.nl>
3  * Copyright (c) 1993 Branko Lankester <branko@hacktic.nl>
4  * Copyright (c) 1993, 1994, 1995, 1996 Rick Sladkey <jrs@world.std.com>
5  * Copyright (c) 1996-2001 Wichert Akkerman <wichert@cistron.nl>
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. The name of the author may not be used to endorse or promote products
17  *    derived from this software without specific prior written permission.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 #include "defs.h"
32 #include <linux/ioctl.h>
33 #include "xlat/ioctl_dirs.h"
34 
35 #ifdef HAVE_LINUX_INPUT_H
36 # include <linux/input.h>
37 #endif
38 
39 #include "xlat/evdev_abs.h"
40 #include "xlat/evdev_ev.h"
41 
42 static int
compare(const void * a,const void * b)43 compare(const void *a, const void *b)
44 {
45 	const unsigned int code1 = (const unsigned long) a;
46 	const unsigned int code2 = ((struct_ioctlent *) b)->code;
47 	return (code1 > code2) ? 1 : (code1 < code2) ? -1 : 0;
48 }
49 
50 static const struct_ioctlent *
ioctl_lookup(const unsigned int code)51 ioctl_lookup(const unsigned int code)
52 {
53 	struct_ioctlent *iop;
54 
55 	iop = bsearch((const void *) (const unsigned long) code, ioctlent,
56 			nioctlents, sizeof(ioctlent[0]), compare);
57 	while (iop > ioctlent) {
58 		iop--;
59 		if (iop->code != code) {
60 			iop++;
61 			break;
62 		}
63 	}
64 	return iop;
65 }
66 
67 static const struct_ioctlent *
ioctl_next_match(const struct_ioctlent * iop)68 ioctl_next_match(const struct_ioctlent *iop)
69 {
70 	const unsigned int code = iop->code;
71 	iop++;
72 	if (iop < ioctlent + nioctlents && iop->code == code)
73 		return iop;
74 	return NULL;
75 }
76 
77 static void
ioctl_print_code(const unsigned int code)78 ioctl_print_code(const unsigned int code)
79 {
80 	tprints("_IOC(");
81 	printflags(ioctl_dirs, _IOC_DIR(code), "_IOC_???");
82 	tprintf(", 0x%02x, 0x%02x, 0x%02x)",
83 		_IOC_TYPE(code), _IOC_NR(code), _IOC_SIZE(code));
84 }
85 
86 static int
evdev_decode_number(const unsigned int code)87 evdev_decode_number(const unsigned int code)
88 {
89 	const unsigned int nr = _IOC_NR(code);
90 
91 	if (_IOC_DIR(code) == _IOC_WRITE) {
92 		if (nr >= 0xc0 && nr <= 0xc0 + 0x3f) {
93 			tprints("EVIOCSABS(");
94 			printxval(evdev_abs, nr - 0xc0, "EV_???");
95 			tprints(")");
96 			return 1;
97 		}
98 	}
99 
100 	if (_IOC_DIR(code) != _IOC_READ)
101 		return 0;
102 
103 	if (nr >= 0x20 && nr <= 0x20 + 0x1f) {
104 		tprints("EVIOCGBIT(");
105 		printxval(evdev_ev, nr - 0x20, "EV_???");
106 		tprintf(", %u)", _IOC_SIZE(code));
107 		return 1;
108 	} else if (nr >= 0x40 && nr <= 0x40 + 0x3f) {
109 		tprints("EVIOCGABS(");
110 		printxval(evdev_abs, nr - 0x40, "ABS_???");
111 		tprints(")");
112 		return 1;
113 	}
114 
115 	switch (_IOC_NR(nr)) {
116 		case 0x06:
117 			tprintf("EVIOCGNAME(%u)", _IOC_SIZE(code));
118 			return 1;
119 		case 0x07:
120 			tprintf("EVIOCGPHYS(%u)", _IOC_SIZE(code));
121 			return 1;
122 		case 0x08:
123 			tprintf("EVIOCGUNIQ(%u)", _IOC_SIZE(code));
124 			return 1;
125 		case 0x09:
126 			tprintf("EVIOCGPROP(%u)", _IOC_SIZE(code));
127 			return 1;
128 		case 0x0a:
129 			tprintf("EVIOCGMTSLOTS(%u)", _IOC_SIZE(code));
130 			return 1;
131 		case 0x18:
132 			tprintf("EVIOCGKEY(%u)", _IOC_SIZE(code));
133 			return 1;
134 		case 0x19:
135 			tprintf("EVIOCGLED(%u)", _IOC_SIZE(code));
136 			return 1;
137 		case 0x1a:
138 			tprintf("EVIOCGSND(%u)", _IOC_SIZE(code));
139 			return 1;
140 		case 0x1b:
141 			tprintf("EVIOCGSW(%u)", _IOC_SIZE(code));
142 			return 1;
143 		default:
144 			return 0;
145 	}
146 }
147 
148 static int
hiddev_decode_number(const unsigned int code)149 hiddev_decode_number(const unsigned int code)
150 {
151 	if (_IOC_DIR(code) == _IOC_READ) {
152 		switch (_IOC_NR(code)) {
153 			case 0x04:
154 				tprintf("HIDIOCGRAWNAME(%u)", _IOC_SIZE(code));
155 				return 1;
156 			case 0x05:
157 				tprintf("HIDIOCGRAWPHYS(%u)", _IOC_SIZE(code));
158 				return 1;
159 			case 0x06:
160 				tprintf("HIDIOCSFEATURE(%u)", _IOC_SIZE(code));
161 				return 1;
162 			case 0x12:
163 				tprintf("HIDIOCGPHYS(%u)", _IOC_SIZE(code));
164 				return 1;
165 			default:
166 				return 0;
167 		}
168 	} else if (_IOC_DIR(code) == (_IOC_READ | _IOC_WRITE)) {
169 		switch (_IOC_NR(code)) {
170 			case 0x06:
171 				tprintf("HIDIOCSFEATURE(%u)", _IOC_SIZE(code));
172 				return 1;
173 			case 0x07:
174 				tprintf("HIDIOCGFEATURE(%u)", _IOC_SIZE(code));
175 				return 1;
176 			default:
177 				return 0;
178 		}
179 	}
180 
181 	return 0;
182 }
183 
184 static int
ioctl_decode_command_number(struct tcb * tcp)185 ioctl_decode_command_number(struct tcb *tcp)
186 {
187 	const unsigned int code = tcp->u_arg[1];
188 
189 	switch (_IOC_TYPE(code)) {
190 		case 'E':
191 			return evdev_decode_number(code);
192 		case 'H':
193 			return hiddev_decode_number(code);
194 		case 'M':
195 			if (_IOC_DIR(code) == _IOC_WRITE) {
196 				tprintf("MIXER_WRITE(%u)", _IOC_NR(code));
197 				return 1;
198 			} else if (_IOC_DIR(code) == _IOC_READ) {
199 				tprintf("MIXER_READ(%u)", _IOC_NR(code));
200 				return 1;
201 			}
202 			return 0;
203 		case 'U':
204 			if (_IOC_DIR(code) == _IOC_READ && _IOC_NR(code) == 0x2c) {
205 				tprintf("UI_GET_SYSNAME(%u)", _IOC_SIZE(code));
206 				return 1;
207 			}
208 			return 0;
209 		case 'j':
210 			if (_IOC_DIR(code) == _IOC_READ && _IOC_NR(code) == 0x13) {
211 				tprintf("JSIOCGNAME(%u)", _IOC_SIZE(code));
212 				return 1;
213 			}
214 			return 0;
215 		case 'k':
216 			if (_IOC_DIR(code) == _IOC_WRITE && _IOC_NR(code) == 0) {
217 				tprintf("SPI_IOC_MESSAGE(%u)", _IOC_SIZE(code));
218 				return 1;
219 			}
220 			return 0;
221 		default:
222 			return 0;
223 	}
224 }
225 
226 static int
ioctl_decode(struct tcb * tcp)227 ioctl_decode(struct tcb *tcp)
228 {
229 	const unsigned int code = tcp->u_arg[1];
230 	const long arg = tcp->u_arg[2];
231 
232 	switch (_IOC_TYPE(code)) {
233 #if defined(ALPHA) || defined(POWERPC)
234 	case 'f': case 't': case 'T':
235 #else /* !ALPHA */
236 	case 0x54:
237 #endif /* !ALPHA */
238 		return term_ioctl(tcp, code, arg);
239 	case 0x89:
240 		return sock_ioctl(tcp, code, arg);
241 	case 'p':
242 		return rtc_ioctl(tcp, code, arg);
243 	case 0x03:
244 	case 0x12:
245 	case 'X':
246 		return block_ioctl(tcp, code, arg);
247 #ifdef HAVE_SCSI_SG_H
248 	case 0x22:
249 		return scsi_ioctl(tcp, code, arg);
250 #endif
251 	case 'L':
252 		return loop_ioctl(tcp, code, arg);
253 	case 'M':
254 		return mtd_ioctl(tcp, code, arg);
255 	case 'o':
256 	case 'O':
257 		return ubi_ioctl(tcp, code, arg);
258 	case 'V':
259 		return v4l2_ioctl(tcp, code, arg);
260 	case '=':
261 		return ptp_ioctl(tcp, code, arg);
262 #ifdef HAVE_LINUX_INPUT_H
263 	case 'E':
264 		return evdev_ioctl(tcp, code, arg);
265 #endif
266 	default:
267 		break;
268 	}
269 	return 0;
270 }
271 
SYS_FUNC(ioctl)272 SYS_FUNC(ioctl)
273 {
274 	const struct_ioctlent *iop;
275 	int ret;
276 
277 	if (entering(tcp)) {
278 		printfd(tcp, tcp->u_arg[0]);
279 		tprints(", ");
280 		ret = ioctl_decode_command_number(tcp);
281 		if (!(ret & IOCTL_NUMBER_STOP_LOOKUP)) {
282 			iop = ioctl_lookup(tcp->u_arg[1]);
283 			if (iop) {
284 				if (ret)
285 					tprints(" or ");
286 				tprints(iop->symbol);
287 				while ((iop = ioctl_next_match(iop)))
288 					tprintf(" or %s", iop->symbol);
289 			} else if (!ret) {
290 				ioctl_print_code(tcp->u_arg[1]);
291 			}
292 		}
293 		ret = ioctl_decode(tcp);
294 	} else {
295 		ret = ioctl_decode(tcp) | RVAL_DECODED;
296 	}
297 
298 	if (ret & RVAL_DECODED) {
299 		ret &= ~RVAL_DECODED;
300 		if (ret)
301 			--ret;
302 		else
303 			tprintf(", %#lx", tcp->u_arg[2]);
304 		ret |= RVAL_DECODED;
305 	} else {
306 		if (ret)
307 			--ret;
308 	}
309 
310 	return ret;
311 }
312