opti; file save

gpio-raw.h

@@ -32,7 +32,8 @@ extern volatile unsigned *gpio;
 #define GPIO_SET *(gpio+7)  // sets   bits which are 1 ignores bits which are 0
 #define GPIO_CLR *(gpio+10) // clears bits which are 1 ignores bits which are 0
 #define GPIO_LEV *(gpio+13)
-#define GPIO_VALUE(PIN) ((GPIO_LEV & (1 << PIN)) != 0)
+#define GPIO_VALUE_R(ALL, PIN) ((ALL & (1 << PIN)) != 0)
+#define GPIO_VALUE(PIN) GPIO_VALUE_R(GPIO_LEV, PIN)
 
 bool setup_io();
 

main.c

@@ -6,53 +6,48 @@
 #include <stdio.h>
 #include <string.h>
 #include <stdlib.h>
-#include <pthread.h>
 #include <signal.h>
 
 #include "gpio-raw.h"
 
-bool thread_exit = false;
 
-static void signal_handler(int signo)
-{
-    thread_exit = true;
-}
+volatile unsigned n = 350000000 / sizeof(unsigned char);
 
-void* worker(void*)
+void signal_handler(int signo)
 {
-  FILE* fd = fopen("clock.out", "w");
-  while (!thread_exit)
-    sleep(1);
-  fclose(fd);
-  return 0;
+  std::cout << "signal catched" << std::endl;
+  n = 0;
 }
 
 int main(int argc, char* argv[])
 {
-  signal(SIGINT, signal_handler);
   setup_io();
-  INP_GPIO(4); // must use INP_GPIO before we can use OUT_GPIO
+  INP_GPIO(4);
 
   struct timeval t1, t2;
-  const int n = argc == 2 ? atoi(argv[1]) : 1000000;
-  pthread_t thread;
-  pthread_create(&thread, 0, worker, 0);
-
+  unsigned char* v = new unsigned char[n];
+  unsigned count = 0;
+  std::cout << "Ready to sniff. Press enter...";
+  getchar();
+  signal(SIGINT, signal_handler);
   gettimeofday(&t1, NULL);
-  for (int i = 0; !thread_exit; ++i)
-  {
-    //GPIO_VALUE(6);
-    //tab[i] = GPIO_VALUE(6);
-    printf("%i\n", GPIO_VALUE(6));
-    //fprintf(fd, "%i\n", v);
-    //GPIO_SET = 1<<4;
-    //GPIO_CLR = 1<<4;
-  }
+    for (; count < n; ++count)
+    {
+      const unsigned value = GPIO_LEV;
+      v[count] = GPIO_VALUE_R(value, 6) | (GPIO_VALUE_R(value, 26) << 1);
+    }
   gettimeofday(&t2, NULL);
-  pthread_join(thread, 0);
+  signal(SIGINT, SIG_DFL);
+  std::cout << "Saving file..." << std::endl;
+  int fd = open("gpio.out", O_CREAT | O_WRONLY);
+  write(fd, (void*)v, count * sizeof(*v));
+  close(fd);
   unsigned long long ut1 = (__suseconds_t)(1000000L * t1.tv_sec + t1.tv_usec);
   unsigned long long ut2 = (__suseconds_t)(1000000L * t2.tv_sec + t2.tv_usec);
-  std::cout << ut1 << " " << ut2 << " ";
-  std::cout << (ut2 - ut1) << " " << (float)(ut2 - ut1) / n << std::endl;
+  unsigned long long diff = ut2 - ut1;
+  double unit = (double)diff / count;
+  double mhz = (1000000.0 / unit) / 1000000.0;
+  std::cout << "count: " << count << " diff: " << diff << " unit: "
+    << unit << " Mhz: " << mhz << std::endl;
   return 0;
 }