first commit

termfix.c

@@ -0,0 +1,64 @@
+/*
+    Copyright (C) 2020-2021 Vincent Buso <vincent.buso@funkey-project.com>
+    Copyright (C) 2020-2021 Michel Stempin <michel.stempin@funkey-project.com>
+
+    This file is part of the FunKey S GPIO keyboard daemon.
+
+    This is free software; you can redistribute it and/or
+    modify it under the terms of the GNU Lesser General Public
+    License as published by the Free Software Foundation; either
+    version 2.1 of the License, or (at your option) any later version.
+
+    The software is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+    Lesser General Public License for more details.
+
+    You should have received a copy of the GNU Lesser General Public
+    License along with the GNU C Library; if not, write to the Free
+    Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
+    02111-1307 USA.  
+*/
+
+/**
+ *  @file termfix.c
+ *  This file contains a function to unlock and force a vt back into text mode
+ */
+
+#include <sys/ioctl.h>
+#include <errno.h>
+#include <string.h>
+#include <stdio.h>
+#include <linux/vt.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <linux/kd.h>
+#include <linux/keyboard.h>
+
+int main(int argc, char** argv)
+{
+    if (argc != 2) {
+        printf("usage: termfix /dev/ttyX\n");
+        return 2;
+    }
+
+    int fd = open(argv[1], O_RDWR, 0);
+    int res = ioctl(fd, VT_UNLOCKSWITCH, 1);
+
+    if (res != 0) {
+        perror("ioctl VT_UNLOCKSWITCH failed");
+        return 3;
+    }
+
+    ioctl(fd, KDSETMODE, KD_TEXT);
+
+    if (res != 0) {
+        perror("ioctl KDSETMODE failed");
+        return 3;
+    }
+
+    printf("Success\n");
+
+    return res;
+}