linux-tty_ioctl.c

/*
 *  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>

extern int session_of_pgrp(int pgrp);
extern int tty_signal(int sig, struct tty_struct *tty);

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)            //－－刷新tty缓冲队列
{
    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)        //－－发送BREAK控制符
{
    /* do nothing - not implemented */
}

static int get_termios(struct tty_struct * tty, struct termios * 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 channel)                            //－－设置终端termios结构信息
{
    int i, retsig;

    /* If we try to set the state of terminal and we're not in the
       foreground, send a SIGTTOU.  If the signal is blocked or
       ignored, go ahead and perform the operation.  POSIX 7.2) */
    if ((current->tty == channel) && (tty->pgrp != current->pgrp)) {
        retsig = tty_signal(SIGTTOU, tty);
        if (retsig == -ERESTARTSYS || retsig == -EINTR)
            return retsig;
    }
    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)
{                                                //－－读取termmio结构中的信息
    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 channel)                        //－－设置终端termio结构信息
{
    int i, retsig;
    struct termio tmp_termio;

    if ((current->tty == channel) && (tty->pgrp != current->pgrp)) {
        retsig = tty_signal(SIGTTOU, tty);
        if (retsig == -ERESTARTSYS || retsig == -EINTR)
            return retsig;
    }
    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)    //－－tty终端设备输入输出控制函数
{
    struct tty_struct * tty;
    int    pgrp;

    if (MAJOR(dev) == 5) {
        dev=current->tty;
        if (dev<0)
            panic("tty_ioctl: dev<0");
    } else
        dev=MINOR(dev);
    tty = tty_table + (dev ? ((dev < 64)? dev-1:dev) : fg_console);
    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, dev);
        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, dev);
        case TCSBRK:
            if (!arg) {
                wait_until_sent(tty);
                send_break(tty);
            }
            return 0;
        case TCXONC:
            switch (arg) {
            case TCOOFF:
                tty->stopped = 1;
                tty->write(tty);
                return 0;
            case TCOON:
                tty->stopped = 0;
                tty->write(tty);
                return 0;
            case TCIOFF:
                if (STOP_CHAR(tty))
                    PUTCH(STOP_CHAR(tty),tty->write_q);
                return 0;
            case TCION:
                if (START_CHAR(tty))
                    PUTCH(START_CHAR(tty),tty->write_q);
                return 0;
            }
            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:
            if ((current->tty < 0) ||
                (current->tty != dev) ||
                (tty->session != current->session))
                return -ENOTTY;
            pgrp=get_fs_long((unsigned long *) arg);
            if (pgrp < 0)
                return -EINVAL;
            if (session_of_pgrp(pgrp) != current->session)
                return -EPERM;
            tty->pgrp = pgrp;           
            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;
    }
}