1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180 |
- /*
- * Copyright (C) 1991, 1992, 1993, 1994 Linus Torvalds
- *
- * Modified by Fred N. van Kempen, 01/29/93, to add line disciplines
- * which can be dynamically activated and de-activated by the line
- * discipline handling modules (like SLIP).
- */
- #include <linux/types.h>
- #include <linux/termios.h>
- #include <linux/errno.h>
- #include <linux/sched.h>
- #include <linux/kernel.h>
- #include <linux/major.h>
- #include <linux/tty.h>
- #include <linux/fcntl.h>
- #include <linux/string.h>
- #include <linux/mm.h>
- #include <linux/module.h>
- #include <linux/bitops.h>
- #include <linux/mutex.h>
- #include <linux/compat.h>
- #include <asm/io.h>
- #include <asm/uaccess.h>
- #undef TTY_DEBUG_WAIT_UNTIL_SENT
- #ifdef TTY_DEBUG_WAIT_UNTIL_SENT
- # define tty_debug_wait_until_sent(tty, f, args...) tty_debug(tty, f, ##args)
- #else
- # define tty_debug_wait_until_sent(tty, f, args...) do {} while (0)
- #endif
- #undef DEBUG
- /*
- * Internal flag options for termios setting behavior
- */
- #define TERMIOS_FLUSH 1
- #define TERMIOS_WAIT 2
- #define TERMIOS_TERMIO 4
- #define TERMIOS_OLD 8
- /**
- * tty_chars_in_buffer - characters pending
- * @tty: terminal
- *
- * Return the number of bytes of data in the device private
- * output queue. If no private method is supplied there is assumed
- * to be no queue on the device.
- */
- int tty_chars_in_buffer(struct tty_struct *tty)
- {
- if (tty->ops->chars_in_buffer)
- return tty->ops->chars_in_buffer(tty);
- else
- return 0;
- }
- EXPORT_SYMBOL(tty_chars_in_buffer);
- /**
- * tty_write_room - write queue space
- * @tty: terminal
- *
- * Return the number of bytes that can be queued to this device
- * at the present time. The result should be treated as a guarantee
- * and the driver cannot offer a value it later shrinks by more than
- * the number of bytes written. If no method is provided 2K is always
- * returned and data may be lost as there will be no flow control.
- */
-
- int tty_write_room(struct tty_struct *tty)
- {
- if (tty->ops->write_room)
- return tty->ops->write_room(tty);
- return 2048;
- }
- EXPORT_SYMBOL(tty_write_room);
- /**
- * tty_driver_flush_buffer - discard internal buffer
- * @tty: terminal
- *
- * Discard the internal output buffer for this device. If no method
- * is provided then either the buffer cannot be hardware flushed or
- * there is no buffer driver side.
- */
- void tty_driver_flush_buffer(struct tty_struct *tty)
- {
- if (tty->ops->flush_buffer)
- tty->ops->flush_buffer(tty);
- }
- EXPORT_SYMBOL(tty_driver_flush_buffer);
- /**
- * tty_throttle - flow control
- * @tty: terminal
- *
- * Indicate that a tty should stop transmitting data down the stack.
- * Takes the termios rwsem to protect against parallel throttle/unthrottle
- * and also to ensure the driver can consistently reference its own
- * termios data at this point when implementing software flow control.
- */
- void tty_throttle(struct tty_struct *tty)
- {
- down_write(&tty->termios_rwsem);
- /* check TTY_THROTTLED first so it indicates our state */
- if (!test_and_set_bit(TTY_THROTTLED, &tty->flags) &&
- tty->ops->throttle)
- tty->ops->throttle(tty);
- tty->flow_change = 0;
- up_write(&tty->termios_rwsem);
- }
- EXPORT_SYMBOL(tty_throttle);
- /**
- * tty_unthrottle - flow control
- * @tty: terminal
- *
- * Indicate that a tty may continue transmitting data down the stack.
- * Takes the termios rwsem to protect against parallel throttle/unthrottle
- * and also to ensure the driver can consistently reference its own
- * termios data at this point when implementing software flow control.
- *
- * Drivers should however remember that the stack can issue a throttle,
- * then change flow control method, then unthrottle.
- */
- void tty_unthrottle(struct tty_struct *tty)
- {
- down_write(&tty->termios_rwsem);
- if (test_and_clear_bit(TTY_THROTTLED, &tty->flags) &&
- tty->ops->unthrottle)
- tty->ops->unthrottle(tty);
- tty->flow_change = 0;
- up_write(&tty->termios_rwsem);
- }
- EXPORT_SYMBOL(tty_unthrottle);
- /**
- * tty_throttle_safe - flow control
- * @tty: terminal
- *
- * Similar to tty_throttle() but will only attempt throttle
- * if tty->flow_change is TTY_THROTTLE_SAFE. Prevents an accidental
- * throttle due to race conditions when throttling is conditional
- * on factors evaluated prior to throttling.
- *
- * Returns 0 if tty is throttled (or was already throttled)
- */
- int tty_throttle_safe(struct tty_struct *tty)
- {
- int ret = 0;
- mutex_lock(&tty->throttle_mutex);
- if (!tty_throttled(tty)) {
- if (tty->flow_change != TTY_THROTTLE_SAFE)
- ret = 1;
- else {
- set_bit(TTY_THROTTLED, &tty->flags);
- if (tty->ops->throttle)
- tty->ops->throttle(tty);
- }
- }
- mutex_unlock(&tty->throttle_mutex);
- return ret;
- }
- /**
- * tty_unthrottle_safe - flow control
- * @tty: terminal
- *
- * Similar to tty_unthrottle() but will only attempt unthrottle
- * if tty->flow_change is TTY_UNTHROTTLE_SAFE. Prevents an accidental
- * unthrottle due to race conditions when unthrottling is conditional
- * on factors evaluated prior to unthrottling.
- *
- * Returns 0 if tty is unthrottled (or was already unthrottled)
- */
- int tty_unthrottle_safe(struct tty_struct *tty)
- {
- int ret = 0;
- mutex_lock(&tty->throttle_mutex);
- if (tty_throttled(tty)) {
- if (tty->flow_change != TTY_UNTHROTTLE_SAFE)
- ret = 1;
- else {
- clear_bit(TTY_THROTTLED, &tty->flags);
- if (tty->ops->unthrottle)
- tty->ops->unthrottle(tty);
- }
- }
- mutex_unlock(&tty->throttle_mutex);
- return ret;
- }
- /**
- * tty_wait_until_sent - wait for I/O to finish
- * @tty: tty we are waiting for
- * @timeout: how long we will wait
- *
- * Wait for characters pending in a tty driver to hit the wire, or
- * for a timeout to occur (eg due to flow control)
- *
- * Locking: none
- */
- void tty_wait_until_sent(struct tty_struct *tty, long timeout)
- {
- tty_debug_wait_until_sent(tty, "wait until sent, timeout=%ld\n", timeout);
- if (!timeout)
- timeout = MAX_SCHEDULE_TIMEOUT;
- timeout = wait_event_interruptible_timeout(tty->write_wait,
- !tty_chars_in_buffer(tty), timeout);
- if (timeout <= 0)
- return;
- if (timeout == MAX_SCHEDULE_TIMEOUT)
- timeout = 0;
- if (tty->ops->wait_until_sent)
- tty->ops->wait_until_sent(tty, timeout);
- }
- EXPORT_SYMBOL(tty_wait_until_sent);
- /*
- * Termios Helper Methods
- */
- static void unset_locked_termios(struct tty_struct *tty, struct ktermios *old)
- {
- struct ktermios *termios = &tty->termios;
- struct ktermios *locked = &tty->termios_locked;
- int i;
- #define NOSET_MASK(x, y, z) (x = ((x) & ~(z)) | ((y) & (z)))
- NOSET_MASK(termios->c_iflag, old->c_iflag, locked->c_iflag);
- NOSET_MASK(termios->c_oflag, old->c_oflag, locked->c_oflag);
- NOSET_MASK(termios->c_cflag, old->c_cflag, locked->c_cflag);
- NOSET_MASK(termios->c_lflag, old->c_lflag, locked->c_lflag);
- termios->c_line = locked->c_line ? old->c_line : termios->c_line;
- for (i = 0; i < NCCS; i++)
- termios->c_cc[i] = locked->c_cc[i] ?
- old->c_cc[i] : termios->c_cc[i];
- /* FIXME: What should we do for i/ospeed */
- }
- /*
- * Routine which returns the baud rate of the tty
- *
- * Note that the baud_table needs to be kept in sync with the
- * include/asm/termbits.h file.
- */
- static const speed_t baud_table[] = {
- 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
- 9600, 19200, 38400, 57600, 115200, 230400, 460800,
- #ifdef __sparc__
- 76800, 153600, 307200, 614400, 921600
- #else
- 500000, 576000, 921600, 1000000, 1152000, 1500000, 2000000,
- 2500000, 3000000, 3500000, 4000000
- #endif
- };
- #ifndef __sparc__
- static const tcflag_t baud_bits[] = {
- B0, B50, B75, B110, B134, B150, B200, B300, B600,
- B1200, B1800, B2400, B4800, B9600, B19200, B38400,
- B57600, B115200, B230400, B460800, B500000, B576000,
- B921600, B1000000, B1152000, B1500000, B2000000, B2500000,
- B3000000, B3500000, B4000000
- };
- #else
- static const tcflag_t baud_bits[] = {
- B0, B50, B75, B110, B134, B150, B200, B300, B600,
- B1200, B1800, B2400, B4800, B9600, B19200, B38400,
- B57600, B115200, B230400, B460800, B76800, B153600,
- B307200, B614400, B921600
- };
- #endif
- static int n_baud_table = ARRAY_SIZE(baud_table);
- /**
- * tty_termios_baud_rate
- * @termios: termios structure
- *
- * Convert termios baud rate data into a speed. This should be called
- * with the termios lock held if this termios is a terminal termios
- * structure. May change the termios data. Device drivers can call this
- * function but should use ->c_[io]speed directly as they are updated.
- *
- * Locking: none
- */
- speed_t tty_termios_baud_rate(struct ktermios *termios)
- {
- unsigned int cbaud;
- cbaud = termios->c_cflag & CBAUD;
- #ifdef BOTHER
- /* Magic token for arbitrary speed via c_ispeed/c_ospeed */
- if (cbaud == BOTHER)
- return termios->c_ospeed;
- #endif
- if (cbaud & CBAUDEX) {
- cbaud &= ~CBAUDEX;
- if (cbaud < 1 || cbaud + 15 > n_baud_table)
- termios->c_cflag &= ~CBAUDEX;
- else
- cbaud += 15;
- }
- return cbaud >= n_baud_table ? 0 : baud_table[cbaud];
- }
- EXPORT_SYMBOL(tty_termios_baud_rate);
- /**
- * tty_termios_input_baud_rate
- * @termios: termios structure
- *
- * Convert termios baud rate data into a speed. This should be called
- * with the termios lock held if this termios is a terminal termios
- * structure. May change the termios data. Device drivers can call this
- * function but should use ->c_[io]speed directly as they are updated.
- *
- * Locking: none
- */
- speed_t tty_termios_input_baud_rate(struct ktermios *termios)
- {
- #ifdef IBSHIFT
- unsigned int cbaud = (termios->c_cflag >> IBSHIFT) & CBAUD;
- if (cbaud == B0)
- return tty_termios_baud_rate(termios);
- /* Magic token for arbitrary speed via c_ispeed*/
- if (cbaud == BOTHER)
- return termios->c_ispeed;
- if (cbaud & CBAUDEX) {
- cbaud &= ~CBAUDEX;
- if (cbaud < 1 || cbaud + 15 > n_baud_table)
- termios->c_cflag &= ~(CBAUDEX << IBSHIFT);
- else
- cbaud += 15;
- }
- return cbaud >= n_baud_table ? 0 : baud_table[cbaud];
- #else
- return tty_termios_baud_rate(termios);
- #endif
- }
- EXPORT_SYMBOL(tty_termios_input_baud_rate);
- /**
- * tty_termios_encode_baud_rate
- * @termios: ktermios structure holding user requested state
- * @ispeed: input speed
- * @ospeed: output speed
- *
- * Encode the speeds set into the passed termios structure. This is
- * used as a library helper for drivers so that they can report back
- * the actual speed selected when it differs from the speed requested
- *
- * For maximal back compatibility with legacy SYS5/POSIX *nix behaviour
- * we need to carefully set the bits when the user does not get the
- * desired speed. We allow small margins and preserve as much of possible
- * of the input intent to keep compatibility.
- *
- * Locking: Caller should hold termios lock. This is already held
- * when calling this function from the driver termios handler.
- *
- * The ifdefs deal with platforms whose owners have yet to update them
- * and will all go away once this is done.
- */
- void tty_termios_encode_baud_rate(struct ktermios *termios,
- speed_t ibaud, speed_t obaud)
- {
- int i = 0;
- int ifound = -1, ofound = -1;
- int iclose = ibaud/50, oclose = obaud/50;
- int ibinput = 0;
- if (obaud == 0) /* CD dropped */
- ibaud = 0; /* Clear ibaud to be sure */
- termios->c_ispeed = ibaud;
- termios->c_ospeed = obaud;
- #ifdef BOTHER
- /* If the user asked for a precise weird speed give a precise weird
- answer. If they asked for a Bfoo speed they may have problems
- digesting non-exact replies so fuzz a bit */
- if ((termios->c_cflag & CBAUD) == BOTHER)
- oclose = 0;
- if (((termios->c_cflag >> IBSHIFT) & CBAUD) == BOTHER)
- iclose = 0;
- if ((termios->c_cflag >> IBSHIFT) & CBAUD)
- ibinput = 1; /* An input speed was specified */
- #endif
- termios->c_cflag &= ~CBAUD;
- /*
- * Our goal is to find a close match to the standard baud rate
- * returned. Walk the baud rate table and if we get a very close
- * match then report back the speed as a POSIX Bxxxx value by
- * preference
- */
- do {
- if (obaud - oclose <= baud_table[i] &&
- obaud + oclose >= baud_table[i]) {
- termios->c_cflag |= baud_bits[i];
- ofound = i;
- }
- if (ibaud - iclose <= baud_table[i] &&
- ibaud + iclose >= baud_table[i]) {
- /* For the case input == output don't set IBAUD bits
- if the user didn't do so */
- if (ofound == i && !ibinput)
- ifound = i;
- #ifdef IBSHIFT
- else {
- ifound = i;
- termios->c_cflag |= (baud_bits[i] << IBSHIFT);
- }
- #endif
- }
- } while (++i < n_baud_table);
- /*
- * If we found no match then use BOTHER if provided or warn
- * the user their platform maintainer needs to wake up if not.
- */
- #ifdef BOTHER
- if (ofound == -1)
- termios->c_cflag |= BOTHER;
- /* Set exact input bits only if the input and output differ or the
- user already did */
- if (ifound == -1 && (ibaud != obaud || ibinput))
- termios->c_cflag |= (BOTHER << IBSHIFT);
- #else
- if (ifound == -1 || ofound == -1)
- pr_warn_once("tty: Unable to return correct speed data as your architecture needs updating.\n");
- #endif
- }
- EXPORT_SYMBOL_GPL(tty_termios_encode_baud_rate);
- /**
- * tty_encode_baud_rate - set baud rate of the tty
- * @ibaud: input baud rate
- * @obad: output baud rate
- *
- * Update the current termios data for the tty with the new speed
- * settings. The caller must hold the termios_rwsem for the tty in
- * question.
- */
- void tty_encode_baud_rate(struct tty_struct *tty, speed_t ibaud, speed_t obaud)
- {
- tty_termios_encode_baud_rate(&tty->termios, ibaud, obaud);
- }
- EXPORT_SYMBOL_GPL(tty_encode_baud_rate);
- /**
- * tty_termios_copy_hw - copy hardware settings
- * @new: New termios
- * @old: Old termios
- *
- * Propagate the hardware specific terminal setting bits from
- * the old termios structure to the new one. This is used in cases
- * where the hardware does not support reconfiguration or as a helper
- * in some cases where only minimal reconfiguration is supported
- */
- void tty_termios_copy_hw(struct ktermios *new, struct ktermios *old)
- {
- /* The bits a dumb device handles in software. Smart devices need
- to always provide a set_termios method */
- new->c_cflag &= HUPCL | CREAD | CLOCAL;
- new->c_cflag |= old->c_cflag & ~(HUPCL | CREAD | CLOCAL);
- new->c_ispeed = old->c_ispeed;
- new->c_ospeed = old->c_ospeed;
- }
- EXPORT_SYMBOL(tty_termios_copy_hw);
- /**
- * tty_termios_hw_change - check for setting change
- * @a: termios
- * @b: termios to compare
- *
- * Check if any of the bits that affect a dumb device have changed
- * between the two termios structures, or a speed change is needed.
- */
- int tty_termios_hw_change(struct ktermios *a, struct ktermios *b)
- {
- if (a->c_ispeed != b->c_ispeed || a->c_ospeed != b->c_ospeed)
- return 1;
- if ((a->c_cflag ^ b->c_cflag) & ~(HUPCL | CREAD | CLOCAL))
- return 1;
- return 0;
- }
- EXPORT_SYMBOL(tty_termios_hw_change);
- /**
- * tty_set_termios - update termios values
- * @tty: tty to update
- * @new_termios: desired new value
- *
- * Perform updates to the termios values set on this terminal.
- * A master pty's termios should never be set.
- *
- * Locking: termios_rwsem
- */
- int tty_set_termios(struct tty_struct *tty, struct ktermios *new_termios)
- {
- struct ktermios old_termios;
- struct tty_ldisc *ld;
- WARN_ON(tty->driver->type == TTY_DRIVER_TYPE_PTY &&
- tty->driver->subtype == PTY_TYPE_MASTER);
- /*
- * Perform the actual termios internal changes under lock.
- */
- /* FIXME: we need to decide on some locking/ordering semantics
- for the set_termios notification eventually */
- down_write(&tty->termios_rwsem);
- old_termios = tty->termios;
- tty->termios = *new_termios;
- unset_locked_termios(tty, &old_termios);
- if (tty->ops->set_termios)
- tty->ops->set_termios(tty, &old_termios);
- else
- tty_termios_copy_hw(&tty->termios, &old_termios);
- ld = tty_ldisc_ref(tty);
- if (ld != NULL) {
- if (ld->ops->set_termios)
- ld->ops->set_termios(tty, &old_termios);
- tty_ldisc_deref(ld);
- }
- up_write(&tty->termios_rwsem);
- return 0;
- }
- EXPORT_SYMBOL_GPL(tty_set_termios);
- /**
- * set_termios - set termios values for a tty
- * @tty: terminal device
- * @arg: user data
- * @opt: option information
- *
- * Helper function to prepare termios data and run necessary other
- * functions before using tty_set_termios to do the actual changes.
- *
- * Locking:
- * Called functions take ldisc and termios_rwsem locks
- */
- static int set_termios(struct tty_struct *tty, void __user *arg, int opt)
- {
- struct ktermios tmp_termios;
- struct tty_ldisc *ld;
- int retval = tty_check_change(tty);
- if (retval)
- return retval;
- down_read(&tty->termios_rwsem);
- tmp_termios = tty->termios;
- up_read(&tty->termios_rwsem);
- if (opt & TERMIOS_TERMIO) {
- if (user_termio_to_kernel_termios(&tmp_termios,
- (struct termio __user *)arg))
- return -EFAULT;
- #ifdef TCGETS2
- } else if (opt & TERMIOS_OLD) {
- if (user_termios_to_kernel_termios_1(&tmp_termios,
- (struct termios __user *)arg))
- return -EFAULT;
- } else {
- if (user_termios_to_kernel_termios(&tmp_termios,
- (struct termios2 __user *)arg))
- return -EFAULT;
- }
- #else
- } else if (user_termios_to_kernel_termios(&tmp_termios,
- (struct termios __user *)arg))
- return -EFAULT;
- #endif
- /* If old style Bfoo values are used then load c_ispeed/c_ospeed
- * with the real speed so its unconditionally usable */
- tmp_termios.c_ispeed = tty_termios_input_baud_rate(&tmp_termios);
- tmp_termios.c_ospeed = tty_termios_baud_rate(&tmp_termios);
- ld = tty_ldisc_ref(tty);
- if (ld != NULL) {
- if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer)
- ld->ops->flush_buffer(tty);
- tty_ldisc_deref(ld);
- }
- if (opt & TERMIOS_WAIT) {
- tty_wait_until_sent(tty, 0);
- if (signal_pending(current))
- return -ERESTARTSYS;
- }
- tty_set_termios(tty, &tmp_termios);
- /* FIXME: Arguably if tmp_termios == tty->termios AND the
- actual requested termios was not tmp_termios then we may
- want to return an error as no user requested change has
- succeeded */
- return 0;
- }
- static void copy_termios(struct tty_struct *tty, struct ktermios *kterm)
- {
- down_read(&tty->termios_rwsem);
- *kterm = tty->termios;
- up_read(&tty->termios_rwsem);
- }
- static void copy_termios_locked(struct tty_struct *tty, struct ktermios *kterm)
- {
- down_read(&tty->termios_rwsem);
- *kterm = tty->termios_locked;
- up_read(&tty->termios_rwsem);
- }
- static int get_termio(struct tty_struct *tty, struct termio __user *termio)
- {
- struct ktermios kterm;
- copy_termios(tty, &kterm);
- if (kernel_termios_to_user_termio(termio, &kterm))
- return -EFAULT;
- return 0;
- }
- #ifdef TCGETX
- /**
- * set_termiox - set termiox fields if possible
- * @tty: terminal
- * @arg: termiox structure from user
- * @opt: option flags for ioctl type
- *
- * Implement the device calling points for the SYS5 termiox ioctl
- * interface in Linux
- */
- static int set_termiox(struct tty_struct *tty, void __user *arg, int opt)
- {
- struct termiox tnew;
- struct tty_ldisc *ld;
- if (tty->termiox == NULL)
- return -EINVAL;
- if (copy_from_user(&tnew, arg, sizeof(struct termiox)))
- return -EFAULT;
- ld = tty_ldisc_ref(tty);
- if (ld != NULL) {
- if ((opt & TERMIOS_FLUSH) && ld->ops->flush_buffer)
- ld->ops->flush_buffer(tty);
- tty_ldisc_deref(ld);
- }
- if (opt & TERMIOS_WAIT) {
- tty_wait_until_sent(tty, 0);
- if (signal_pending(current))
- return -ERESTARTSYS;
- }
- down_write(&tty->termios_rwsem);
- if (tty->ops->set_termiox)
- tty->ops->set_termiox(tty, &tnew);
- up_write(&tty->termios_rwsem);
- return 0;
- }
- #endif
- #ifdef TIOCGETP
- /*
- * These are deprecated, but there is limited support..
- *
- * The "sg_flags" translation is a joke..
- */
- static int get_sgflags(struct tty_struct *tty)
- {
- int flags = 0;
- if (!L_ICANON(tty)) {
- if (L_ISIG(tty))
- flags |= 0x02; /* cbreak */
- else
- flags |= 0x20; /* raw */
- }
- if (L_ECHO(tty))
- flags |= 0x08; /* echo */
- if (O_OPOST(tty))
- if (O_ONLCR(tty))
- flags |= 0x10; /* crmod */
- return flags;
- }
- static int get_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb)
- {
- struct sgttyb tmp;
- down_read(&tty->termios_rwsem);
- tmp.sg_ispeed = tty->termios.c_ispeed;
- tmp.sg_ospeed = tty->termios.c_ospeed;
- tmp.sg_erase = tty->termios.c_cc[VERASE];
- tmp.sg_kill = tty->termios.c_cc[VKILL];
- tmp.sg_flags = get_sgflags(tty);
- up_read(&tty->termios_rwsem);
- return copy_to_user(sgttyb, &tmp, sizeof(tmp)) ? -EFAULT : 0;
- }
- static void set_sgflags(struct ktermios *termios, int flags)
- {
- termios->c_iflag = ICRNL | IXON;
- termios->c_oflag = 0;
- termios->c_lflag = ISIG | ICANON;
- if (flags & 0x02) { /* cbreak */
- termios->c_iflag = 0;
- termios->c_lflag &= ~ICANON;
- }
- if (flags & 0x08) { /* echo */
- termios->c_lflag |= ECHO | ECHOE | ECHOK |
- ECHOCTL | ECHOKE | IEXTEN;
- }
- if (flags & 0x10) { /* crmod */
- termios->c_oflag |= OPOST | ONLCR;
- }
- if (flags & 0x20) { /* raw */
- termios->c_iflag = 0;
- termios->c_lflag &= ~(ISIG | ICANON);
- }
- if (!(termios->c_lflag & ICANON)) {
- termios->c_cc[VMIN] = 1;
- termios->c_cc[VTIME] = 0;
- }
- }
- /**
- * set_sgttyb - set legacy terminal values
- * @tty: tty structure
- * @sgttyb: pointer to old style terminal structure
- *
- * Updates a terminal from the legacy BSD style terminal information
- * structure.
- *
- * Locking: termios_rwsem
- */
- static int set_sgttyb(struct tty_struct *tty, struct sgttyb __user *sgttyb)
- {
- int retval;
- struct sgttyb tmp;
- struct ktermios termios;
- retval = tty_check_change(tty);
- if (retval)
- return retval;
- if (copy_from_user(&tmp, sgttyb, sizeof(tmp)))
- return -EFAULT;
- down_write(&tty->termios_rwsem);
- termios = tty->termios;
- termios.c_cc[VERASE] = tmp.sg_erase;
- termios.c_cc[VKILL] = tmp.sg_kill;
- set_sgflags(&termios, tmp.sg_flags);
- /* Try and encode into Bfoo format */
- #ifdef BOTHER
- tty_termios_encode_baud_rate(&termios, termios.c_ispeed,
- termios.c_ospeed);
- #endif
- up_write(&tty->termios_rwsem);
- tty_set_termios(tty, &termios);
- return 0;
- }
- #endif
- #ifdef TIOCGETC
- static int get_tchars(struct tty_struct *tty, struct tchars __user *tchars)
- {
- struct tchars tmp;
- down_read(&tty->termios_rwsem);
- tmp.t_intrc = tty->termios.c_cc[VINTR];
- tmp.t_quitc = tty->termios.c_cc[VQUIT];
- tmp.t_startc = tty->termios.c_cc[VSTART];
- tmp.t_stopc = tty->termios.c_cc[VSTOP];
- tmp.t_eofc = tty->termios.c_cc[VEOF];
- tmp.t_brkc = tty->termios.c_cc[VEOL2]; /* what is brkc anyway? */
- up_read(&tty->termios_rwsem);
- return copy_to_user(tchars, &tmp, sizeof(tmp)) ? -EFAULT : 0;
- }
- static int set_tchars(struct tty_struct *tty, struct tchars __user *tchars)
- {
- struct tchars tmp;
- if (copy_from_user(&tmp, tchars, sizeof(tmp)))
- return -EFAULT;
- down_write(&tty->termios_rwsem);
- tty->termios.c_cc[VINTR] = tmp.t_intrc;
- tty->termios.c_cc[VQUIT] = tmp.t_quitc;
- tty->termios.c_cc[VSTART] = tmp.t_startc;
- tty->termios.c_cc[VSTOP] = tmp.t_stopc;
- tty->termios.c_cc[VEOF] = tmp.t_eofc;
- tty->termios.c_cc[VEOL2] = tmp.t_brkc; /* what is brkc anyway? */
- up_write(&tty->termios_rwsem);
- return 0;
- }
- #endif
- #ifdef TIOCGLTC
- static int get_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars)
- {
- struct ltchars tmp;
- down_read(&tty->termios_rwsem);
- tmp.t_suspc = tty->termios.c_cc[VSUSP];
- /* what is dsuspc anyway? */
- tmp.t_dsuspc = tty->termios.c_cc[VSUSP];
- tmp.t_rprntc = tty->termios.c_cc[VREPRINT];
- /* what is flushc anyway? */
- tmp.t_flushc = tty->termios.c_cc[VEOL2];
- tmp.t_werasc = tty->termios.c_cc[VWERASE];
- tmp.t_lnextc = tty->termios.c_cc[VLNEXT];
- up_read(&tty->termios_rwsem);
- return copy_to_user(ltchars, &tmp, sizeof(tmp)) ? -EFAULT : 0;
- }
- static int set_ltchars(struct tty_struct *tty, struct ltchars __user *ltchars)
- {
- struct ltchars tmp;
- if (copy_from_user(&tmp, ltchars, sizeof(tmp)))
- return -EFAULT;
- down_write(&tty->termios_rwsem);
- tty->termios.c_cc[VSUSP] = tmp.t_suspc;
- /* what is dsuspc anyway? */
- tty->termios.c_cc[VEOL2] = tmp.t_dsuspc;
- tty->termios.c_cc[VREPRINT] = tmp.t_rprntc;
- /* what is flushc anyway? */
- tty->termios.c_cc[VEOL2] = tmp.t_flushc;
- tty->termios.c_cc[VWERASE] = tmp.t_werasc;
- tty->termios.c_cc[VLNEXT] = tmp.t_lnextc;
- up_write(&tty->termios_rwsem);
- return 0;
- }
- #endif
- /**
- * tty_change_softcar - carrier change ioctl helper
- * @tty: tty to update
- * @arg: enable/disable CLOCAL
- *
- * Perform a change to the CLOCAL state and call into the driver
- * layer to make it visible. All done with the termios rwsem
- */
- static int tty_change_softcar(struct tty_struct *tty, int arg)
- {
- int ret = 0;
- int bit = arg ? CLOCAL : 0;
- struct ktermios old;
- down_write(&tty->termios_rwsem);
- old = tty->termios;
- tty->termios.c_cflag &= ~CLOCAL;
- tty->termios.c_cflag |= bit;
- if (tty->ops->set_termios)
- tty->ops->set_termios(tty, &old);
- if (C_CLOCAL(tty) != bit)
- ret = -EINVAL;
- up_write(&tty->termios_rwsem);
- return ret;
- }
- /**
- * tty_mode_ioctl - mode related ioctls
- * @tty: tty for the ioctl
- * @file: file pointer for the tty
- * @cmd: command
- * @arg: ioctl argument
- *
- * Perform non line discipline specific mode control ioctls. This
- * is designed to be called by line disciplines to ensure they provide
- * consistent mode setting.
- */
- int tty_mode_ioctl(struct tty_struct *tty, struct file *file,
- unsigned int cmd, unsigned long arg)
- {
- struct tty_struct *real_tty;
- void __user *p = (void __user *)arg;
- int ret = 0;
- struct ktermios kterm;
- BUG_ON(file == NULL);
- if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
- tty->driver->subtype == PTY_TYPE_MASTER)
- real_tty = tty->link;
- else
- real_tty = tty;
- switch (cmd) {
- #ifdef TIOCGETP
- case TIOCGETP:
- return get_sgttyb(real_tty, (struct sgttyb __user *) arg);
- case TIOCSETP:
- case TIOCSETN:
- return set_sgttyb(real_tty, (struct sgttyb __user *) arg);
- #endif
- #ifdef TIOCGETC
- case TIOCGETC:
- return get_tchars(real_tty, p);
- case TIOCSETC:
- return set_tchars(real_tty, p);
- #endif
- #ifdef TIOCGLTC
- case TIOCGLTC:
- return get_ltchars(real_tty, p);
- case TIOCSLTC:
- return set_ltchars(real_tty, p);
- #endif
- case TCSETSF:
- return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_OLD);
- case TCSETSW:
- return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_OLD);
- case TCSETS:
- return set_termios(real_tty, p, TERMIOS_OLD);
- #ifndef TCGETS2
- case TCGETS:
- copy_termios(real_tty, &kterm);
- if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm))
- ret = -EFAULT;
- return ret;
- #else
- case TCGETS:
- copy_termios(real_tty, &kterm);
- if (kernel_termios_to_user_termios_1((struct termios __user *)arg, &kterm))
- ret = -EFAULT;
- return ret;
- case TCGETS2:
- copy_termios(real_tty, &kterm);
- if (kernel_termios_to_user_termios((struct termios2 __user *)arg, &kterm))
- ret = -EFAULT;
- return ret;
- case TCSETSF2:
- return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT);
- case TCSETSW2:
- return set_termios(real_tty, p, TERMIOS_WAIT);
- case TCSETS2:
- return set_termios(real_tty, p, 0);
- #endif
- case TCGETA:
- return get_termio(real_tty, p);
- case TCSETAF:
- return set_termios(real_tty, p, TERMIOS_FLUSH | TERMIOS_WAIT | TERMIOS_TERMIO);
- case TCSETAW:
- return set_termios(real_tty, p, TERMIOS_WAIT | TERMIOS_TERMIO);
- case TCSETA:
- return set_termios(real_tty, p, TERMIOS_TERMIO);
- #ifndef TCGETS2
- case TIOCGLCKTRMIOS:
- copy_termios_locked(real_tty, &kterm);
- if (kernel_termios_to_user_termios((struct termios __user *)arg, &kterm))
- ret = -EFAULT;
- return ret;
- case TIOCSLCKTRMIOS:
- if (!capable(CAP_SYS_ADMIN))
- return -EPERM;
- copy_termios_locked(real_tty, &kterm);
- if (user_termios_to_kernel_termios(&kterm,
- (struct termios __user *) arg))
- return -EFAULT;
- down_write(&real_tty->termios_rwsem);
- real_tty->termios_locked = kterm;
- up_write(&real_tty->termios_rwsem);
- return 0;
- #else
- case TIOCGLCKTRMIOS:
- copy_termios_locked(real_tty, &kterm);
- if (kernel_termios_to_user_termios_1((struct termios __user *)arg, &kterm))
- ret = -EFAULT;
- return ret;
- case TIOCSLCKTRMIOS:
- if (!capable(CAP_SYS_ADMIN))
- return -EPERM;
- copy_termios_locked(real_tty, &kterm);
- if (user_termios_to_kernel_termios_1(&kterm,
- (struct termios __user *) arg))
- return -EFAULT;
- down_write(&real_tty->termios_rwsem);
- real_tty->termios_locked = kterm;
- up_write(&real_tty->termios_rwsem);
- return ret;
- #endif
- #ifdef TCGETX
- case TCGETX: {
- struct termiox ktermx;
- if (real_tty->termiox == NULL)
- return -EINVAL;
- down_read(&real_tty->termios_rwsem);
- memcpy(&ktermx, real_tty->termiox, sizeof(struct termiox));
- up_read(&real_tty->termios_rwsem);
- if (copy_to_user(p, &ktermx, sizeof(struct termiox)))
- ret = -EFAULT;
- return ret;
- }
- case TCSETX:
- return set_termiox(real_tty, p, 0);
- case TCSETXW:
- return set_termiox(real_tty, p, TERMIOS_WAIT);
- case TCSETXF:
- return set_termiox(real_tty, p, TERMIOS_FLUSH);
- #endif
- case TIOCGSOFTCAR:
- copy_termios(real_tty, &kterm);
- ret = put_user((kterm.c_cflag & CLOCAL) ? 1 : 0,
- (int __user *)arg);
- return ret;
- case TIOCSSOFTCAR:
- if (get_user(arg, (unsigned int __user *) arg))
- return -EFAULT;
- return tty_change_softcar(real_tty, arg);
- default:
- return -ENOIOCTLCMD;
- }
- }
- EXPORT_SYMBOL_GPL(tty_mode_ioctl);
- /* Caller guarantees ldisc reference is held */
- static int __tty_perform_flush(struct tty_struct *tty, unsigned long arg)
- {
- struct tty_ldisc *ld = tty->ldisc;
- switch (arg) {
- case TCIFLUSH:
- if (ld && ld->ops->flush_buffer) {
- ld->ops->flush_buffer(tty);
- tty_unthrottle(tty);
- }
- break;
- case TCIOFLUSH:
- if (ld && ld->ops->flush_buffer) {
- ld->ops->flush_buffer(tty);
- tty_unthrottle(tty);
- }
- /* fall through */
- case TCOFLUSH:
- tty_driver_flush_buffer(tty);
- break;
- default:
- return -EINVAL;
- }
- return 0;
- }
- int tty_perform_flush(struct tty_struct *tty, unsigned long arg)
- {
- struct tty_ldisc *ld;
- int retval = tty_check_change(tty);
- if (retval)
- return retval;
- ld = tty_ldisc_ref_wait(tty);
- retval = __tty_perform_flush(tty, arg);
- if (ld)
- tty_ldisc_deref(ld);
- return retval;
- }
- EXPORT_SYMBOL_GPL(tty_perform_flush);
- int n_tty_ioctl_helper(struct tty_struct *tty, struct file *file,
- unsigned int cmd, unsigned long arg)
- {
- int retval;
- switch (cmd) {
- case TCXONC:
- retval = tty_check_change(tty);
- if (retval)
- return retval;
- switch (arg) {
- case TCOOFF:
- spin_lock_irq(&tty->flow_lock);
- if (!tty->flow_stopped) {
- tty->flow_stopped = 1;
- __stop_tty(tty);
- }
- spin_unlock_irq(&tty->flow_lock);
- break;
- case TCOON:
- spin_lock_irq(&tty->flow_lock);
- if (tty->flow_stopped) {
- tty->flow_stopped = 0;
- __start_tty(tty);
- }
- spin_unlock_irq(&tty->flow_lock);
- break;
- case TCIOFF:
- if (STOP_CHAR(tty) != __DISABLED_CHAR)
- retval = tty_send_xchar(tty, STOP_CHAR(tty));
- break;
- case TCION:
- if (START_CHAR(tty) != __DISABLED_CHAR)
- retval = tty_send_xchar(tty, START_CHAR(tty));
- break;
- default:
- return -EINVAL;
- }
- return retval;
- case TCFLSH:
- retval = tty_check_change(tty);
- if (retval)
- return retval;
- return __tty_perform_flush(tty, arg);
- default:
- /* Try the mode commands */
- return tty_mode_ioctl(tty, file, cmd, arg);
- }
- }
- EXPORT_SYMBOL(n_tty_ioctl_helper);
- #ifdef CONFIG_COMPAT
- long n_tty_compat_ioctl_helper(struct tty_struct *tty, struct file *file,
- unsigned int cmd, unsigned long arg)
- {
- switch (cmd) {
- case TIOCGLCKTRMIOS:
- case TIOCSLCKTRMIOS:
- return tty_mode_ioctl(tty, file, cmd, (unsigned long) compat_ptr(arg));
- default:
- return -ENOIOCTLCMD;
- }
- }
- EXPORT_SYMBOL(n_tty_compat_ioctl_helper);
- #endif
|