ADD file via upload

2 years ago · 83e8857bad
parent 467edff5a0
commit 83e8857bad
1 changed files with 204 additions and 0 deletions
--- a/kernel/chr_drv/tty_ioctl.c
+++ b/kernel/chr_drv/tty_ioctl.c
@ -0,0 +1,204 @@
+/*
+ *  linux/kernel/chr_drv/tty_ioctl.c
+ *
+ *  (C) 1991  Linus Torvalds
+ */
+
+#include <errno.h>
+#include <termios.h>
+
+#include <linux/sched.h>
+#include <linux/kernel.h>
+#include <linux/tty.h>
+
+#include <asm/io.h>
+#include <asm/segment.h>
+#include <asm/system.h>
+
+static unsigned short quotient[] = {
+	0, 2304, 1536, 1047, 857,
+	768, 576, 384, 192, 96,
+	64, 48, 24, 12, 6, 3
+};
+
+static void change_speed(struct tty_struct * tty)
+{
+	unsigned short port,quot;
+
+	if (!(port = tty->read_q.data))
+		return;
+	quot = quotient[tty->termios.c_cflag & CBAUD];
+	cli();
+	outb_p(0x80,port+3);		/* set DLAB */
+	outb_p(quot & 0xff,port);	/* LS of divisor */
+	outb_p(quot >> 8,port+1);	/* MS of divisor */
+	outb(0x03,port+3);		/* reset DLAB */
+	sti();
+}
+
+static void flush(struct tty_queue * queue)
+{
+	cli();
+	queue->head = queue->tail;
+	sti();
+}
+
+static void wait_until_sent(struct tty_struct * tty)
+{
+	/* do nothing - not implemented */
+}
+
+static void send_break(struct tty_struct * tty)
+{
+	/* do nothing - not implemented */
+}
+
+static int get_termios(struct tty_struct * tty, struct termios * termios)
+{
+	int i;
+
+	verify_area(termios, sizeof (*termios));
+	for (i=0 ; i< (sizeof (*termios)) ; i++)
+		put_fs_byte( ((char *)&tty->termios)[i] , i+(char *)termios );
+	return 0;
+}
+
+static int set_termios(struct tty_struct * tty, struct termios * termios)
+{
+	int i;
+
+	for (i=0 ; i< (sizeof (*termios)) ; i++)
+		((char *)&tty->termios)[i]=get_fs_byte(i+(char *)termios);
+	change_speed(tty);
+	return 0;
+}
+
+static int get_termio(struct tty_struct * tty, struct termio * termio)
+{
+	int i;
+	struct termio tmp_termio;
+
+	verify_area(termio, sizeof (*termio));
+	tmp_termio.c_iflag = tty->termios.c_iflag;
+	tmp_termio.c_oflag = tty->termios.c_oflag;
+	tmp_termio.c_cflag = tty->termios.c_cflag;
+	tmp_termio.c_lflag = tty->termios.c_lflag;
+	tmp_termio.c_line = tty->termios.c_line;
+	for(i=0 ; i < NCC ; i++)
+		tmp_termio.c_cc[i] = tty->termios.c_cc[i];
+	for (i=0 ; i< (sizeof (*termio)) ; i++)
+		put_fs_byte( ((char *)&tmp_termio)[i] , i+(char *)termio );
+	return 0;
+}
+
+/*
+ * This only works as the 386 is low-byt-first
+ */
+static int set_termio(struct tty_struct * tty, struct termio * termio)
+{
+	int i;
+	struct termio tmp_termio;
+
+	for (i=0 ; i< (sizeof (*termio)) ; i++)
+		((char *)&tmp_termio)[i]=get_fs_byte(i+(char *)termio);
+	*(unsigned short *)&tty->termios.c_iflag = tmp_termio.c_iflag;
+	*(unsigned short *)&tty->termios.c_oflag = tmp_termio.c_oflag;
+	*(unsigned short *)&tty->termios.c_cflag = tmp_termio.c_cflag;
+	*(unsigned short *)&tty->termios.c_lflag = tmp_termio.c_lflag;
+	tty->termios.c_line = tmp_termio.c_line;
+	for(i=0 ; i < NCC ; i++)
+		tty->termios.c_cc[i] = tmp_termio.c_cc[i];
+	change_speed(tty);
+	return 0;
+}
+
+int tty_ioctl(int dev, int cmd, int arg)
+{
+	struct tty_struct * tty;
+	if (MAJOR(dev) == 5) {
+		dev=current->tty;
+		if (dev<0)
+			panic("tty_ioctl: dev<0");
+	} else
+		dev=MINOR(dev);
+	tty = dev + tty_table;
+	switch (cmd) {
+		case TCGETS:
+			return get_termios(tty,(struct termios *) arg);
+		case TCSETSF:
+			flush(&tty->read_q); /* fallthrough */
+		case TCSETSW:
+			wait_until_sent(tty); /* fallthrough */
+		case TCSETS:
+			return set_termios(tty,(struct termios *) arg);
+		case TCGETA:
+			return get_termio(tty,(struct termio *) arg);
+		case TCSETAF:
+			flush(&tty->read_q); /* fallthrough */
+		case TCSETAW:
+			wait_until_sent(tty); /* fallthrough */
+		case TCSETA:
+			return set_termio(tty,(struct termio *) arg);
+		case TCSBRK:
+			if (!arg) {
+				wait_until_sent(tty);
+				send_break(tty);
+			}
+			return 0;
+		case TCXONC:
+			return -EINVAL; /* not implemented */
+		case TCFLSH:
+			if (arg==0)
+				flush(&tty->read_q);
+			else if (arg==1)
+				flush(&tty->write_q);
+			else if (arg==2) {
+				flush(&tty->read_q);
+				flush(&tty->write_q);
+			} else
+				return -EINVAL;
+			return 0;
+		case TIOCEXCL:
+			return -EINVAL; /* not implemented */
+		case TIOCNXCL:
+			return -EINVAL; /* not implemented */
+		case TIOCSCTTY:
+			return -EINVAL; /* set controlling term NI */
+		case TIOCGPGRP:
+			verify_area((void *) arg,4);
+			put_fs_long(tty->pgrp,(unsigned long *) arg);
+			return 0;
+		case TIOCSPGRP:
+			tty->pgrp=get_fs_long((unsigned long *) arg);
+			return 0;
+		case TIOCOUTQ:
+			verify_area((void *) arg,4);
+			put_fs_long(CHARS(tty->write_q),(unsigned long *) arg);
+			return 0;
+		case TIOCINQ:
+			verify_area((void *) arg,4);
+			put_fs_long(CHARS(tty->secondary),
+				(unsigned long *) arg);
+			return 0;
+		case TIOCSTI:
+			return -EINVAL; /* not implemented */
+		case TIOCGWINSZ:
+			return -EINVAL; /* not implemented */
+		case TIOCSWINSZ:
+			return -EINVAL; /* not implemented */
+		case TIOCMGET:
+			return -EINVAL; /* not implemented */
+		case TIOCMBIS:
+			return -EINVAL; /* not implemented */
+		case TIOCMBIC:
+			return -EINVAL; /* not implemented */
+		case TIOCMSET:
+			return -EINVAL; /* not implemented */
+		case TIOCGSOFTCAR:
+			return -EINVAL; /* not implemented */
+		case TIOCSSOFTCAR:
+			return -EINVAL; /* not implemented */
+		default:
+			return -EINVAL;
+	}
+}