• Home
  • History
  • Annotate
  • Line#
  • Navigate
  • Raw
  • Download
  • only in /asuswrt-rt-n18u-9.0.0.4.380.2695/release/src-rt-6.x.4708/linux/linux-2.6.36/arch/um/drivers/
1/*
2 * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{linux.intel,addtoit}.com)
3 * Licensed under the GPL
4 */
5
6#include <stdlib.h>
7#include <unistd.h>
8#include <errno.h>
9#include <sched.h>
10#include <signal.h>
11#include <termios.h>
12#include <sys/ioctl.h>
13#include "chan_user.h"
14#include "kern_constants.h"
15#include "os.h"
16#include "um_malloc.h"
17#include "user.h"
18
19void generic_close(int fd, void *unused)
20{
21	close(fd);
22}
23
24int generic_read(int fd, char *c_out, void *unused)
25{
26	int n;
27
28	n = read(fd, c_out, sizeof(*c_out));
29	if (n > 0)
30		return n;
31	else if (errno == EAGAIN)
32		return 0;
33	else if (n == 0)
34		return -EIO;
35	return -errno;
36}
37
38
39int generic_write(int fd, const char *buf, int n, void *unused)
40{
41	int err;
42
43	err = write(fd, buf, n);
44	if (err > 0)
45		return err;
46	else if (errno == EAGAIN)
47		return 0;
48	else if (err == 0)
49		return -EIO;
50	return -errno;
51}
52
53int generic_window_size(int fd, void *unused, unsigned short *rows_out,
54			unsigned short *cols_out)
55{
56	struct winsize size;
57	int ret;
58
59	if (ioctl(fd, TIOCGWINSZ, &size) < 0)
60		return -errno;
61
62	ret = ((*rows_out != size.ws_row) || (*cols_out != size.ws_col));
63
64	*rows_out = size.ws_row;
65	*cols_out = size.ws_col;
66
67	return ret;
68}
69
70void generic_free(void *data)
71{
72	kfree(data);
73}
74
75int generic_console_write(int fd, const char *buf, int n)
76{
77	sigset_t old, no_sigio;
78	struct termios save, new;
79	int err;
80
81	if (isatty(fd)) {
82		sigemptyset(&no_sigio);
83		sigaddset(&no_sigio, SIGIO);
84		if (sigprocmask(SIG_BLOCK, &no_sigio, &old))
85			goto error;
86
87		CATCH_EINTR(err = tcgetattr(fd, &save));
88		if (err)
89			goto error;
90		new = save;
91		/*
92		 * The terminal becomes a bit less raw, to handle \n also as
93		 * "Carriage Return", not only as "New Line". Otherwise, the new
94		 * line won't start at the first column.
95		 */
96		new.c_oflag |= OPOST;
97		CATCH_EINTR(err = tcsetattr(fd, TCSAFLUSH, &new));
98		if (err)
99			goto error;
100	}
101	err = generic_write(fd, buf, n, NULL);
102	/*
103	 * Restore raw mode, in any case; we *must* ignore any error apart
104	 * EINTR, except for debug.
105	 */
106	if (isatty(fd)) {
107		CATCH_EINTR(tcsetattr(fd, TCSAFLUSH, &save));
108		sigprocmask(SIG_SETMASK, &old, NULL);
109	}
110
111	return err;
112error:
113	return -errno;
114}
115
116/*
117 * UML SIGWINCH handling
118 *
119 * The point of this is to handle SIGWINCH on consoles which have host
120 * ttys and relay them inside UML to whatever might be running on the
121 * console and cares about the window size (since SIGWINCH notifies
122 * about terminal size changes).
123 *
124 * So, we have a separate thread for each host tty attached to a UML
125 * device (side-issue - I'm annoyed that one thread can't have
126 * multiple controlling ttys for the purpose of handling SIGWINCH, but
127 * I imagine there are other reasons that doesn't make any sense).
128 *
129 * SIGWINCH can't be received synchronously, so you have to set up to
130 * receive it as a signal.  That being the case, if you are going to
131 * wait for it, it is convenient to sit in sigsuspend() and wait for
132 * the signal to bounce you out of it (see below for how we make sure
133 * to exit only on SIGWINCH).
134 */
135
136static void winch_handler(int sig)
137{
138}
139
140struct winch_data {
141	int pty_fd;
142	int pipe_fd;
143};
144
145static int winch_thread(void *arg)
146{
147	struct winch_data *data = arg;
148	sigset_t sigs;
149	int pty_fd, pipe_fd;
150	int count;
151	char c = 1;
152
153	pty_fd = data->pty_fd;
154	pipe_fd = data->pipe_fd;
155	count = write(pipe_fd, &c, sizeof(c));
156	if (count != sizeof(c))
157		printk(UM_KERN_ERR "winch_thread : failed to write "
158		       "synchronization byte, err = %d\n", -count);
159
160	/*
161	 * We are not using SIG_IGN on purpose, so don't fix it as I thought to
162	 * do! If using SIG_IGN, the sigsuspend() call below would not stop on
163	 * SIGWINCH.
164	 */
165
166	signal(SIGWINCH, winch_handler);
167	sigfillset(&sigs);
168	/* Block all signals possible. */
169	if (sigprocmask(SIG_SETMASK, &sigs, NULL) < 0) {
170		printk(UM_KERN_ERR "winch_thread : sigprocmask failed, "
171		       "errno = %d\n", errno);
172		exit(1);
173	}
174	/* In sigsuspend(), block anything else than SIGWINCH. */
175	sigdelset(&sigs, SIGWINCH);
176
177	if (setsid() < 0) {
178		printk(UM_KERN_ERR "winch_thread : setsid failed, errno = %d\n",
179		       errno);
180		exit(1);
181	}
182
183	if (ioctl(pty_fd, TIOCSCTTY, 0) < 0) {
184		printk(UM_KERN_ERR "winch_thread : TIOCSCTTY failed on "
185		       "fd %d err = %d\n", pty_fd, errno);
186		exit(1);
187	}
188
189	if (tcsetpgrp(pty_fd, os_getpid()) < 0) {
190		printk(UM_KERN_ERR "winch_thread : tcsetpgrp failed on "
191		       "fd %d err = %d\n", pty_fd, errno);
192		exit(1);
193	}
194
195	/*
196	 * These are synchronization calls between various UML threads on the
197	 * host - since they are not different kernel threads, we cannot use
198	 * kernel semaphores. We don't use SysV semaphores because they are
199	 * persistent.
200	 */
201	count = read(pipe_fd, &c, sizeof(c));
202	if (count != sizeof(c))
203		printk(UM_KERN_ERR "winch_thread : failed to read "
204		       "synchronization byte, err = %d\n", errno);
205
206	while(1) {
207		/*
208		 * This will be interrupted by SIGWINCH only, since
209		 * other signals are blocked.
210		 */
211		sigsuspend(&sigs);
212
213		count = write(pipe_fd, &c, sizeof(c));
214		if (count != sizeof(c))
215			printk(UM_KERN_ERR "winch_thread : write failed, "
216			       "err = %d\n", errno);
217	}
218}
219
220static int winch_tramp(int fd, struct tty_struct *tty, int *fd_out,
221		       unsigned long *stack_out)
222{
223	struct winch_data data;
224	int fds[2], n, err;
225	char c;
226
227	err = os_pipe(fds, 1, 1);
228	if (err < 0) {
229		printk(UM_KERN_ERR "winch_tramp : os_pipe failed, err = %d\n",
230		       -err);
231		goto out;
232	}
233
234	data = ((struct winch_data) { .pty_fd 		= fd,
235				      .pipe_fd 		= fds[1] } );
236	/*
237	 * CLONE_FILES so this thread doesn't hold open files which are open
238	 * now, but later closed in a different thread.  This is a
239	 * problem with /dev/net/tun, which if held open by this
240	 * thread, prevents the TUN/TAP device from being reused.
241	 */
242	err = run_helper_thread(winch_thread, &data, CLONE_FILES, stack_out);
243	if (err < 0) {
244		printk(UM_KERN_ERR "fork of winch_thread failed - errno = %d\n",
245		       -err);
246		goto out_close;
247	}
248
249	*fd_out = fds[0];
250	n = read(fds[0], &c, sizeof(c));
251	if (n != sizeof(c)) {
252		printk(UM_KERN_ERR "winch_tramp : failed to read "
253		       "synchronization byte\n");
254		printk(UM_KERN_ERR "read failed, err = %d\n", errno);
255		printk(UM_KERN_ERR "fd %d will not support SIGWINCH\n", fd);
256		err = -EINVAL;
257		goto out_close;
258	}
259
260	if (os_set_fd_block(*fd_out, 0)) {
261		printk(UM_KERN_ERR "winch_tramp: failed to set thread_fd "
262		       "non-blocking.\n");
263		goto out_close;
264	}
265
266	return err;
267
268 out_close:
269	close(fds[1]);
270	close(fds[0]);
271 out:
272	return err;
273}
274
275void register_winch(int fd, struct tty_struct *tty)
276{
277	unsigned long stack;
278	int pid, thread, count, thread_fd = -1;
279	char c = 1;
280
281	if (!isatty(fd))
282		return;
283
284	pid = tcgetpgrp(fd);
285	if (!is_skas_winch(pid, fd, tty) && (pid == -1)) {
286		thread = winch_tramp(fd, tty, &thread_fd, &stack);
287		if (thread < 0)
288			return;
289
290		register_winch_irq(thread_fd, fd, thread, tty, stack);
291
292		count = write(thread_fd, &c, sizeof(c));
293		if (count != sizeof(c))
294			printk(UM_KERN_ERR "register_winch : failed to write "
295			       "synchronization byte, err = %d\n", errno);
296	}
297}
298