X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Usermode%2FLibraries%2Flibposix.so_src%2Ftermios.c;h=d3aaefac8f5f063c69d662ce43deaa50f901787f;hb=624e1386acc66a0a5fa51fa9c4aa1f616eddaaa4;hp=0e8e35643951545d457359a5484ca1ef595f622b;hpb=4c78a1bdd506cda6cda27ee342165c7dfa7ecdc2;p=tpg%2Facess2.git

diff --git a/Usermode/Libraries/libposix.so_src/termios.c b/Usermode/Libraries/libposix.so_src/termios.c
index 0e8e3564..d3aaefac 100644
--- a/Usermode/Libraries/libposix.so_src/termios.c
+++ b/Usermode/Libraries/libposix.so_src/termios.c
@@ -8,26 +8,53 @@
 #include <termios.h>
 #include <errno.h>
 #include <string.h>
+#include <acess/sys.h>
+#include <acess/devices/pty.h>
 
 // === CODE ===
+speed_t cfgetospeed(const struct termios *termios_p)
+{
+	return termios_p->c_oflag & CBAUD;
+}
+
 int tcgetattr(int fd, struct termios *termios_p)
 {
 	if( fd == -1 ) {
 		errno = EBADF;
 		return -1;
 	}
+	
 	// Double-check `fd` describes a terminal
+	if( _SysIOCtl(fd, DRV_IOCTL_TYPE, NULL) != DRV_TYPE_TERMINAL ) {
+		errno = EINVAL;
+		return -1;
+	}
 	
 	// Fill defaults
 	memset(termios_p, 0, sizeof(struct termios));
 
-	// Query kernel for other params	
+	// Query kernel for other params
+	struct ptymode	mode;
+	_SysIOCtl(fd, PTY_IOCTL_GETMODE, &mode);
+
+	if( (mode.OutputMode & PTYOMODE_BUFFMT) != PTYBUFFMT_TEXT ) {
+		_SysDebug("Call to tcgetattr when terminal is not in text mode");
+		return -1;
+	}
+
+	if(mode.InputMode & PTYIMODE_CANON)
+		termios_p->c_lflag |= ICANON|ECHOE|ECHOK;
+	if(mode.InputMode & PTYIMODE_ECHO)
+		termios_p->c_lflag |= ECHO;
+	// TODO: The more subtle flags
 
 	return 0;
 }
 
 int tcsetattr(int fd, int optional_actions, const struct termios *termios_p)
 {
+	_SysDebug("tcsetattr(%i, 0%o, %p)", fd, optional_actions, termios_p);
+
 	if( fd == -1 ) {
 		errno = EBADF;
 		return -1;
@@ -37,7 +64,24 @@ int tcsetattr(int fd, int optional_actions, const struct termios *termios_p)
 		errno = EINVAL;
 		return -1;
 	}
+	_SysDebug("*termios_p = {%x,%x,%x,%x}",
+		termios_p->c_iflag, termios_p->c_oflag, termios_p->c_cflag, termios_p->c_lflag);
+	
+	// Double-check `fd` describes a terminal
+	if( _SysIOCtl(fd, DRV_IOCTL_TYPE, NULL) != DRV_TYPE_TERMINAL ) {
+		errno = EINVAL;
+		return -1;
+	}
+
+	struct ptymode	mode = {0,0};
 	
+	if(termios_p->c_lflag & ICANON)
+		mode.InputMode |= PTYIMODE_CANON;
+	if(termios_p->c_lflag & ECHO)
+		mode.InputMode |= PTYIMODE_ECHO;
+
+	_SysIOCtl(fd, PTY_IOCTL_SETMODE, &mode);
+
 	return 0;
 }