diff --git a/src/tty.c b/src/tty.c
index f1f78c0..06e2a6b 100644
--- a/src/tty.c
+++ b/src/tty.c
@@ -306,6 +306,11 @@ void handle_command_sequence(char input_char, char previous_char, char *output_c
     }
 }
 
+void stdin_restore(void)
+{
+    tcsetattr(STDIN_FILENO, TCSANOW, &stdin_old);
+}
+
 void stdin_configure(void)
 {
     int status;
@@ -339,9 +344,9 @@ void stdin_configure(void)
     atexit(&stdin_restore);
 }
 
-void stdin_restore(void)
+void stdout_restore(void)
 {
-    tcsetattr(STDIN_FILENO, TCSANOW, &stdin_old);
+    tcsetattr(STDOUT_FILENO, TCSANOW, &stdout_old);
 }
 
 void stdout_configure(void)
@@ -384,11 +389,6 @@ void stdout_configure(void)
     atexit(&stdout_restore);
 }
 
-void stdout_restore(void)
-{
-    tcsetattr(STDOUT_FILENO, TCSANOW, &stdout_old);
-}
-
 void tty_configure(void)
 {
     bool token_found = true;
diff --git a/src/tty.h b/src/tty.h
index 081ba47..339dce9 100644
--- a/src/tty.h
+++ b/src/tty.h
@@ -42,13 +42,11 @@
 #define NORMAL 0
 #define HEX 1
 
+extern bool interactive_mode;
+
 void stdout_configure(void);
-void stdout_restore(void);
 void stdin_configure(void);
-void stdin_restore(void);
 void tty_configure(void);
 int tty_connect(void);
 void tty_wait_for_device(void);
 void list_serial_devices(void);
-
-extern bool interactive_mode;