blob: 3d7a3a80f000bb4f29d79555b7cd02d13d10a1ef (
plain) (
tree)
|
|
/*
* 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;
}
|