diff options
Diffstat (limited to 'cpukit/libcsupport/src/termios_setbestbaud.c')
-rw-r--r-- | cpukit/libcsupport/src/termios_setbestbaud.c | 45 |
1 files changed, 45 insertions, 0 deletions
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 + * <rtems@embedded-brains.de> + * + * 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 <rtems/termiostypes.h> + +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; +} |