aboutsummaryrefslogtreecommitdiff
path: root/toys/pending/openvt.c
blob: 5aecd94566dcbff1dd8f4359a8c27071e02c878a (plain)
1
2
3
4
5
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
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
/* openvt.c - Run a program on a new VT
 *
 * Copyright 2014 Vivek Kumar Bhagat <vivek.bhagat89@gmail.com>
 *
 * No Standard

USE_OPENVT(NEWTOY(openvt, "c#<1>63sw", TOYFLAG_BIN|TOYFLAG_NEEDROOT))

config OPENVT
  bool "openvt"
  default n
  help
    usage: openvt [-c N] [-s] [-w] [--] [command [command_options]]

    start a program on a new virtual terminal (VT)

    -c N  Use VT N
    -s    Switch to new VT
    -w    Wait for command to exit
          if -s and -w option used together, switch back
          to originating VT when command completes
*/

#define FOR_openvt
#include "toys.h"
#include <linux/vt.h>
#include <linux/kd.h>

GLOBALS(
	unsigned long vt_num;
)

int find_console_fd(void)
{
	char *console_name[] = {"/dev/tty", "/dev/tty0", "/dev/console"};
	int i;
	int fd;
	char arg;

	for (i = 0; i < 3; i++) {
		fd = open(console_name[i], O_RDWR);
		if (fd < 0 && errno == EACCES)
			fd = open(console_name[i], O_RDONLY);

		if (fd < 0 && errno == EACCES)
			fd = open(console_name[i], O_WRONLY);

		if (fd >= 0) {
			arg = 0;
			if (0 == ioctl(fd, KDGKBTYPE, &arg))
				return fd;
			else
				close(fd);
		}
	}

	/* check std fd 0, 1 and 2 */
	for (fd = 0; fd < 3; fd++) {
		arg = 0;
		if (0 == ioctl(fd, KDGKBTYPE, &arg))
			return fd;
	}

	return -1;
}

int xvtnum(int fd)
{
	int ret;

	ret = ioctl(fd, VT_OPENQRY, (int *)&TT.vt_num);
	if (ret != 0 || TT.vt_num <= 0) perror_exit("can't find open VT");

	return TT.vt_num;
}

void openvt_main(void)
{
	int fd = -1, vt_fd = -1, pid, ret = 0;
	struct vt_stat vstate;

	if (!(toys.optflags & FLAG_c)) {
		// check if fd 0,1 or 2 is already opened
		for (fd = 0; fd < 3; fd++)
			if (!ioctl(fd, VT_GETSTATE, &vstate)) {
				ret = xvtnum(fd);
				break;
			}

		// find VT number using /dev/console
		if (!ret) {
			fd = xopen("/dev/console", O_RDONLY | O_NONBLOCK);
			xioctl(fd, VT_GETSTATE, &vstate);
			xvtnum(fd);
		}
	}

	sprintf(toybuf, "/dev/tty%lu", TT.vt_num);
	fd = find_console_fd();
	xioctl(fd, VT_GETSTATE, &vstate);

	close(0);	//new vt becomes stdin
	vt_fd = xopen(toybuf, O_RDWR);
	if (toys.optflags & FLAG_s) {
		ioctl(vt_fd, VT_ACTIVATE, TT.vt_num);
		ioctl(vt_fd, VT_WAITACTIVE, TT.vt_num);
	}

	close(1);
	close(2);
	dup2(vt_fd, 1);
	dup2(vt_fd, 2);
	while (vt_fd > 2)
		close(vt_fd--);

	pid = vfork();
	if (pid < 0)	perror_exit("Fork failed");
	else if (!pid) {
		setsid();
		ioctl(vt_fd, TIOCSCTTY, 0);
		xexec(toys.optargs);
	}

	if (toys.optflags & FLAG_w) {
		while (-1 == waitpid(pid, NULL, 0) && errno == EINTR)
			;
		if (toys.optflags & FLAG_s) {
			ioctl(fd, VT_ACTIVATE, vstate.v_active);
			ioctl(fd, VT_WAITACTIVE, vstate.v_active);
			//check why deallocate isn't working here
			xioctl(fd, VT_DISALLOCATE, (void *)(ptrdiff_t)TT.vt_num); 
		}
	}
}