root / prex-0.9.0 / usr / lib / posix / file / ioctl.c @ 03e9c04a
History | View | Annotate | Download (2.56 KB)
1 |
/*
|
---|---|
2 |
* Copyright (c) 2007, Kohsuke Ohtani
|
3 |
* All rights reserved.
|
4 |
*
|
5 |
* Redistribution and use in source and binary forms, with or without
|
6 |
* modification, are permitted provided that the following conditions
|
7 |
* are met:
|
8 |
* 1. Redistributions of source code must retain the above copyright
|
9 |
* notice, this list of conditions and the following disclaimer.
|
10 |
* 2. Redistributions in binary form must reproduce the above copyright
|
11 |
* notice, this list of conditions and the following disclaimer in the
|
12 |
* documentation and/or other materials provided with the distribution.
|
13 |
* 3. Neither the name of the author nor the names of any co-contributors
|
14 |
* may be used to endorse or promote products derived from this software
|
15 |
* without specific prior written permission.
|
16 |
*
|
17 |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
18 |
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
19 |
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
20 |
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
21 |
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
22 |
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
23 |
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
24 |
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
25 |
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
26 |
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
27 |
* SUCH DAMAGE.
|
28 |
*/
|
29 |
|
30 |
#include <sys/prex.h> |
31 |
#include <sys/posix.h> |
32 |
#include <ipc/fs.h> |
33 |
#include <sys/ioctl.h> |
34 |
|
35 |
#include <errno.h> |
36 |
#include <stdarg.h> |
37 |
#include <string.h> |
38 |
|
39 |
int
|
40 |
ioctl(int fd, unsigned long cmd, ...) |
41 |
{ |
42 |
struct ioctl_msg m;
|
43 |
char *argp;
|
44 |
va_list args; |
45 |
size_t size; |
46 |
int retval = 0; |
47 |
|
48 |
va_start(args, cmd); |
49 |
argp = va_arg(args, char *);
|
50 |
va_end(args); |
51 |
|
52 |
/*
|
53 |
* Check the parameter size
|
54 |
*/
|
55 |
size = IOCPARM_LEN(cmd); |
56 |
if (size > IOCPARM_MAX) {
|
57 |
errno = EINVAL; |
58 |
return -1; |
59 |
} |
60 |
|
61 |
/*
|
62 |
* Check fault
|
63 |
*/
|
64 |
if ((cmd & IOC_IN && (cmd & IOC_IVAL) == 0 && argp == NULL) || |
65 |
(cmd & IOC_OUT && (cmd & IOC_OVAL) == 0 && argp == NULL)) { |
66 |
errno = EFAULT; |
67 |
return -1; |
68 |
} |
69 |
|
70 |
/*
|
71 |
* Copy in
|
72 |
*/
|
73 |
if (cmd & IOC_IN) {
|
74 |
if (cmd & IOC_IVAL)
|
75 |
*((int *)m.buf) = (int)argp; |
76 |
else
|
77 |
memcpy(&m.buf, argp, size); |
78 |
} |
79 |
|
80 |
m.hdr.code = FS_IOCTL; |
81 |
m.fd = fd; |
82 |
m.request = cmd; |
83 |
if (__posix_call(__fs_obj, &m, sizeof(m), 0) != 0) |
84 |
return -1; |
85 |
|
86 |
/*
|
87 |
* Copy out
|
88 |
*/
|
89 |
if (cmd & IOC_OUT) {
|
90 |
if (cmd & IOC_OVAL)
|
91 |
retval = *((int *)m.buf);
|
92 |
else
|
93 |
memcpy(argp, &m.buf, size); |
94 |
} |
95 |
|
96 |
return retval;
|
97 |
} |