From 93726e5205daaa7475cf17c8f916a8b1842affca Mon Sep 17 00:00:00 2001 From: Sebastian Huber Date: Wed, 9 Jul 2014 15:44:13 +0200 Subject: termios: Add rtems_termios_set_best_baud() --- cpukit/libcsupport/src/termios_setbestbaud.c | 45 ++++++++++++++++++++++++++++ 1 file changed, 45 insertions(+) create mode 100644 cpukit/libcsupport/src/termios_setbestbaud.c (limited to 'cpukit/libcsupport/src/termios_setbestbaud.c') diff --git a/cpukit/libcsupport/src/termios_setbestbaud.c b/cpukit/libcsupport/src/termios_setbestbaud.c new file mode 100644 index 0000000000..3d7a3a80f0 --- /dev/null +++ b/cpukit/libcsupport/src/termios_setbestbaud.c @@ -0,0 +1,45 @@ +/* + * Copyright (c) 2014 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#if HAVE_CONFIG_H + #include "config.h" +#endif + +#include + +void rtems_termios_set_best_baud( + rtems_termios_tty *tty, + uint32_t baud +) +{ + const rtems_assoc_t *current = &rtems_termios_baud_table[ 0 ]; + const rtems_assoc_t *last = current; + tcflag_t cbaud_mask = CBAUD; + tcflag_t cbaud; + + while ( current->name != NULL && current->local_value < baud ) { + last = current; + ++current; + } + + if ( current->name != NULL ) { + uint32_t mid = (last->local_value + current->local_value) / UINT32_C( 2 ); + + cbaud = baud <= mid ? last->remote_value : current->remote_value; + } else { + cbaud = B460800; + } + + tty->termios.c_cflag = (tty->termios.c_cflag & ~cbaud_mask) | cbaud; +} -- cgit v1.2.3