1229 lines · 31.4 KB · C
RawDownload
/* *  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 #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 (!test_bit(TTY_THROTTLED, &tty->flags)) {		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 (test_bit(TTY_THROTTLED, &tty->flags)) {		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){#ifdef TTY_DEBUG_WAIT_UNTIL_SENT	char buf[64]; 	printk(KERN_DEBUG "%s wait until sent...\n", tty_name(tty, buf));#endif	if (!timeout)		timeout = MAX_SCHEDULE_TIMEOUT;	if (wait_event_interruptible_timeout(tty->write_wait,			!tty_chars_in_buffer(tty), 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 ktermios *termios,				 struct ktermios *old,				 struct ktermios *locked){	int	i; #define NOSET_MASK(x, y, z) (x = ((x) & ~(z)) | ((y) & (z))) 	if (!locked) {		printk(KERN_WARNING "Warning?!? termios_locked is NULL.\n");		return;	} 	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};#elsestatic 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 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 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 many 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) {		printk_once(KERN_WARNING "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;}

Lines 1–500 of 1229.