From f15a7c3035636a3ad15be578f0046b188419bc9e Mon Sep 17 00:00:00 2001
From: Chris Boudacoff <d3v1c3nv11@users.noreply.github.com>
Date: Wed, 14 Mar 2018 16:28:33 +0200
Subject: [PATCH] added startup check for pluged periferials

---
 .../teres1-audioselect/teres1-audioselect.c   | 182 +++++++++++++-----
 1 file changed, 139 insertions(+), 43 deletions(-)

diff --git a/SOFTWARE/A64-TERES/teres1-audioselect/teres1-audioselect.c b/SOFTWARE/A64-TERES/teres1-audioselect/teres1-audioselect.c
index 67389d52..712d544f 100644
--- a/SOFTWARE/A64-TERES/teres1-audioselect/teres1-audioselect.c
+++ b/SOFTWARE/A64-TERES/teres1-audioselect/teres1-audioselect.c
@@ -14,52 +14,23 @@
 #include <fcntl.h>
 #include <stdio.h>
 #include <stdlib.h>
-
 #include <linux/input.h>
+#include <signal.h>
+#include <sys/types.h>
+#include <sys/mman.h>
+#include <unistd.h>
+#include <string.h>
 
+#define SW_AC_IO_BASE 0x01c22c00
+#define SUNXI_HMIC_STS 0x01c22c00+0x319
 
-void usage(void)
-{
-  extern char *program_invocation_short_name;
-  printf("USAGE:\n");
-  printf("   %s /dev/input/eventX\n", program_invocation_short_name);
-  printf("\n");
-}
-
-int main (int argc, char **argv)
-{
-  const char *device = NULL;
-  int fd;
-  struct input_event ie;
-
-  if (!argv[1])
-  {
-    usage();
-    exit(0);
-  }
-
-  device = argv[1];
-
-  if((fd = open(device, O_RDONLY)) == -1)
-  {
-    perror("Could not open input device");
-    exit(255);
-  }
-
-
-
-  while(read(fd, &ie, sizeof(struct input_event)))
-  {
-	  printf("type %d\tcode %d\tvalue %d\n", ie.type, ie.code, ie.value);
-    switch (ie.type)
-    {
-		
-    case 5: // pluged
-      switch (ie.code) {
+unsigned long SUNXI_PIO_BASE = 0;
+void select_mode(char mmsel,char mval){
+	      switch (mmsel) {
 		  
       case 2: // headphones
-        printf("Headphones: %d\n", ie.value);
-        if (ie.value == 0)
+  //      printf("Headphones: %d\n", mval);
+        if (mval == 0)
         {
 			system("amixer -c 0 set \"External Speaker\" on > /dev/null");
 			system("amixer -c 0 set \"Headphone\" off > /dev/null");
@@ -72,8 +43,8 @@ int main (int argc, char **argv)
         break;
         
       case 4: // mice
-        printf("Microphone: %d\n", ie.value);
-                if (ie.value == 0)
+  //      printf("Microphone: %d\n", mval);
+                if (mval == 0)
         {
 			system("amixer -c 0 sset \"RADC input Mixer MIC1 boost\" unmute > /dev/null" );
 			system("amixer -c 0 sset \"LADC input Mixer MIC1 boost\" unmute > /dev/null");
@@ -97,9 +68,134 @@ int main (int argc, char **argv)
 		}
         break;
       }
+	
+}
+const char *readLine(FILE *file) {
+
+    if (file == NULL) {
+        printf("Error: file pointer is null.");
+        exit(1);
+    }
+
+    int maximumLineLength = 128;
+    char *lineBuffer = (char *)malloc(sizeof(char) * maximumLineLength);
+
+    if (lineBuffer == NULL) {
+        printf("Error allocating memory for line buffer.");
+        exit(1);
+    }
+
+    char ch = getc(file);
+    int count = 0;
+
+    while ((ch != '\n') && (ch != EOF)) {
+        if (count == maximumLineLength) {
+            maximumLineLength += 128;
+            lineBuffer = realloc(lineBuffer, maximumLineLength);
+            if (lineBuffer == NULL) {
+                printf("Error reallocating space for line buffer.");
+                exit(1);
+            }
+        }
+        lineBuffer[count] = ch;
+        count++;
+
+        ch = getc(file);
+    }
+
+    lineBuffer[count] = '\0';
+    char line[count + 1];
+    strncpy(line, lineBuffer, (count + 1));
+    free(lineBuffer);
+    const char *constLine = line;
+    return constLine;
+}
+int main (int argc, char **argv)
+{
+  const char *device = NULL;
+  const char *debug;
+  int fd;
+  struct input_event ie;
+
+FILE *uenv;
+/*
+ * When started without argument just check for jack and set mixer
+ */
+     uenv=fopen("/boot/uEnv.txt","r");
+    if (uenv) { 
+    while(1)
+    {
+	  debug = readLine(uenv);
+	  if (strlen(debug)==0) break; 
+	  if (strcmp(debug,"debug=on")==0) {
+		  // device is in debug mode!!!
+		  select_mode(2,0);
+		  select_mode(4,0);
+		  exit(0);
+	  }
+	}	
+  }
+  
+  
+  
+    off_t offset = SUNXI_HMIC_STS;
+    size_t len = 0x01;
+    size_t pagesize = sysconf(_SC_PAGE_SIZE);
+    off_t page_base = (offset / pagesize) * pagesize;
+    off_t page_offset = offset - page_base;
+
+    fd = open("/dev/mem", O_SYNC);
+    unsigned char *mem = mmap(NULL, page_offset + len, PROT_READ | PROT_WRITE, MAP_PRIVATE, fd, page_base);
+    if (mem == MAP_FAILED) {
+        perror("Can't map memory");
+        return -1;
+    }
+
+    if ((int)mem[page_offset] && 0x08)  //headset?
+		select_mode(4,1);
+		else
+		select_mode(4,0);
+    if ((int)mem[page_offset] && 0x04)  //headphone?
+		select_mode(2,1);
+		else
+		select_mode(2,0);		
+      
+	close(fd);
+     
+     
+      if (!argv[1])
+				exit(0);
+				
+	
+device = argv[1];
+
+for (;;)
+{
+  if((fd = open(device, O_RDONLY)) == -1)
+  {
+    perror("Could not open input device ");
+    exit(255);
+  }
+
+
+
+  while(read(fd, &ie, sizeof(struct input_event))>0)
+  {
+	//  printf("type %d\tcode %d\tvalue %d\n", ie.type, ie.code, ie.value);
+    switch (ie.type)
+    {
+		
+    case 5: // pluged
+    
+	select_mode(ie.code,ie.value);
+	
       break;
     }
   }
 
+close(fd);
+usleep(65535u);
+}
+
   return 0;
 }