1 files changed, 67 insertions, 0 deletions
diff --git a/mdk-stage1/dietlibc/lib/speed.c b/mdk-stage1/dietlibc/lib/speed.c
new file mode 100644
index 000000000..a7fcca7c9
--- /dev/null
+++ b/mdk-stage1/dietlibc/lib/speed.c
@@ -0,0 +1,67 @@
+#include <unistd.h>
+#include <termios.h>
+#include <sys/types.h>
+
+#include <asm/errno.h>
+
+extern int errno;
+
+/* Hack around a kernel bug; value must correspond to the one used in tcsetattr.c */
+#define IBAUD0	020000000000
+
+
+/* Return the output baud rate stored in *TERMIOS_P.  */
+speed_t cfgetospeed (struct termios *termios_p)
+{
+	return termios_p->c_cflag & (CBAUD | CBAUDEX);
+}
+
+
+/* Return the input baud rate stored in *TERMIOS_P.
+   Although for Linux there is no difference between input and output
+   speed, the numerical 0 is a special case for the input baud rate. It
+   should set the input baud rate to the output baud rate. */
+speed_t cfgetispeed (struct termios *termios_p)
+{
+	return ((termios_p->c_iflag & IBAUD0)
+		? 0 : termios_p->c_cflag & (CBAUD | CBAUDEX));
+}
+
+
+/* Set the output baud rate stored in *TERMIOS_P to SPEED.  */
+int cfsetospeed (struct termios *termios_p, speed_t speed)
+{
+	if ((speed & ~CBAUD) != 0 && (speed < B57600 || speed > B460800)) {
+		errno = EINVAL;
+		return -1;
+	}
+	
+	termios_p->c_cflag &= ~(CBAUD | CBAUDEX);
+	termios_p->c_cflag |= speed;
+	
+	return 0;
+}
+
+
+/* Set the input baud rate stored in *TERMIOS_P to SPEED.
+   Although for Linux there is no difference between input and output
+   speed, the numerical 0 is a special case for the input baud rate.  It
+   should set the input baud rate to the output baud rate.  */
+int cfsetispeed (struct termios *termios_p, speed_t speed)
+{
+	if ((speed & ~CBAUD) != 0 && (speed < B57600 || speed > B460800)) {
+		errno = EINVAL;
+		return -1;
+	}
+	
+	if (speed == 0)
+		termios_p->c_iflag |= IBAUD0;
+	else
+	{
+		termios_p->c_iflag &= ~IBAUD0;
+		termios_p->c_cflag &= ~(CBAUD | CBAUDEX);
+		termios_p->c_cflag |= speed;
+	}
+	
+	return 0;
+}