xref: /onnv-gate/usr/src/lib/libc/port/gen/cfsetispeed.c (revision 6812:febeba71273d)
10Sstevel@tonic-gate /*
20Sstevel@tonic-gate  * CDDL HEADER START
30Sstevel@tonic-gate  *
40Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5*6812Sraf  * Common Development and Distribution License (the "License").
6*6812Sraf  * You may not use this file except in compliance with the License.
70Sstevel@tonic-gate  *
80Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
90Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
100Sstevel@tonic-gate  * See the License for the specific language governing permissions
110Sstevel@tonic-gate  * and limitations under the License.
120Sstevel@tonic-gate  *
130Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
140Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
150Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
160Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
170Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
180Sstevel@tonic-gate  *
190Sstevel@tonic-gate  * CDDL HEADER END
200Sstevel@tonic-gate  */
21*6812Sraf 
220Sstevel@tonic-gate /*
23*6812Sraf  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
240Sstevel@tonic-gate  * Use is subject to license terms.
250Sstevel@tonic-gate  */
260Sstevel@tonic-gate 
270Sstevel@tonic-gate /*	Copyright (c) 1988 AT&T	*/
280Sstevel@tonic-gate /*	  All Rights Reserved  	*/
290Sstevel@tonic-gate 
30*6812Sraf #pragma ident	"%Z%%M%	%I%	%E% SMI"
310Sstevel@tonic-gate 
32*6812Sraf #pragma weak _cfsetispeed = cfsetispeed
33*6812Sraf 
34*6812Sraf #include "lint.h"
350Sstevel@tonic-gate #include <sys/types.h>
360Sstevel@tonic-gate #include <sys/termios.h>
370Sstevel@tonic-gate 
380Sstevel@tonic-gate /*
390Sstevel@tonic-gate  * sets the input baud rate stored in c_cflag to speed
400Sstevel@tonic-gate  */
410Sstevel@tonic-gate 
420Sstevel@tonic-gate int
cfsetispeed(struct termios * termios_p,speed_t speed)430Sstevel@tonic-gate cfsetispeed(struct termios *termios_p, speed_t speed)
440Sstevel@tonic-gate {
450Sstevel@tonic-gate 	/*
460Sstevel@tonic-gate 	 * If the input speed is zero, set it to output speed
470Sstevel@tonic-gate 	 */
480Sstevel@tonic-gate 	if (speed == 0) {
490Sstevel@tonic-gate 		speed = termios_p->c_cflag & CBAUD;
500Sstevel@tonic-gate 		if (termios_p->c_cflag & CBAUDEXT)
510Sstevel@tonic-gate 			speed += (CBAUD + 1);
520Sstevel@tonic-gate 	}
530Sstevel@tonic-gate 
540Sstevel@tonic-gate 	if ((speed << 16) > CIBAUD) {
550Sstevel@tonic-gate 		termios_p->c_cflag |= CIBAUDEXT;
560Sstevel@tonic-gate 		speed -= ((CIBAUD >> 16) + 1);
570Sstevel@tonic-gate 	} else
580Sstevel@tonic-gate 		termios_p->c_cflag &= ~CIBAUDEXT;
590Sstevel@tonic-gate 	termios_p->c_cflag =
600Sstevel@tonic-gate 	    (termios_p->c_cflag & ~CIBAUD) | ((speed << 16) & CIBAUD);
610Sstevel@tonic-gate 	return (0);
620Sstevel@tonic-gate }
63