X-Git-Url: https://iankelling.org/git/?p=evhz;a=blobdiff_plain;f=evhz.c;h=4fd770dadc8e30ce843c5f1b8fb585c5ff2686d2;hp=e3cc90cda2f6194e2c84c5813b4796481a76751b;hb=HEAD;hpb=f5959ab704b2d9c9539bd435da4b9a18d8008700

diff --git a/evhz.c b/evhz.c
index e3cc90c..950f727 100644
--- a/evhz.c
+++ b/evhz.c
@@ -1,3 +1,9 @@
+/* The license of this program  follows the GNU license recommendations at */
+/* https://www.gnu.org/licenses/license-recommendations.en.html. They */
+/* recommend that small programs, < 300 lines, be licensed under the */
+/* Apache License 2.0. This file contains or is part of one or more small */
+/* programs. */
+
 /* Copyright (C) 2016 Ian Kelling */
 
 /* Licensed under the Apache License, Version 2.0 (the "License"); */
@@ -19,7 +25,7 @@
 #include <getopt.h>
 #include <unistd.h>
 
-#define EVENTS 50
+#define EVENTS 400
 #define HZ_LIST 64
 
 typedef struct event_s {
@@ -27,7 +33,7 @@ typedef struct event_s {
     int hz[HZ_LIST];
     int count;
     int avghz;
-    double prvtime;
+    unsigned long long prev_time;
     char name[128];
 } event_t;
 
@@ -42,6 +48,7 @@ int main(int argc, char *argv[]) {
     int i;
     event_t events[EVENTS];
     int verbose = 1;
+    int max_event = 0;
 
     while((optch = getopt(argc, argv, "hn")) != -1) {
         switch(optch) {
@@ -70,12 +77,15 @@ int main(int argc, char *argv[]) {
 
     // List input devices
     for(i = 0; i < EVENTS; i++) {
-        char device[19];
+        // 20 is needed for 3 digits of event devs under the expected format, but
+        // just give it some extra in case.
+        char device[30];
 
         sprintf(device, "/dev/input/event%i", i);
         events[i].fd = open(device, O_RDONLY);
 		
         if(events[i].fd != -1) {
+            max_event = i;
             ioctl(events[i].fd, EVIOCGNAME(sizeof(events[i].name)), events[i].name);
             if(verbose) printf("event%i: %s\n", i, events[i].name);
         }
@@ -86,58 +96,67 @@ int main(int argc, char *argv[]) {
 
         FD_ZERO(&set);
 
-        for(i = 0; i < EVENTS; i++) {
+        for(i = 0; i <= max_event; i++) {
             if(events[i].fd != -1) {
                 FD_SET(events[i].fd, &set);
             }
         }
 
-        if(select(FD_SETSIZE, &set, NULL, NULL, NULL) > 0) {
-            int bytes;
-            struct input_event event;
+        if(select(FD_SETSIZE, &set, NULL, NULL, NULL) <= 0) {
+            continue;
+        }
 
-            for(i = 0; i < EVENTS; i++) {
-                if(events[i].fd == -1 || !FD_ISSET(events[i].fd, &set)) {
-                    continue;
-                }
+        int bytes;
+        struct input_event event;
 
-                bytes = read(events[i].fd, &event, sizeof(event));
+        for(i = 0; i <= max_event; i++) {
+            if(events[i].fd == -1 || !FD_ISSET(events[i].fd, &set)) {
+                continue;
+            }
 
-                if(bytes != sizeof(event)) {
-                    continue;
-                }
+            bytes = read(events[i].fd, &event, sizeof(event));
 
-                if(event.type == EV_REL || event.type == EV_ABS) {
-                    double time;
-                    int hz;
+            if(bytes != sizeof(event)) {
+                continue;
+            }
 
-                    time = event.time.tv_sec * 1000 + event.time.tv_usec / 1000;
-                    hz = 1000 / (time - events[i].prvtime);
+            if(event.type == EV_REL || event.type == EV_ABS) {
+                unsigned long long time, timediff;
+                unsigned hz = 0;
 
-                    if(hz > 0) {
-                        int j;
+                time = (unsigned long long)event.time.tv_sec * 1000000ULL;
+                time += (unsigned long long)event.time.tv_usec;
 
-                        events[i].count++;
-                        events[i].hz[events[i].count & (HZ_LIST - 1)] = hz;
+                timediff = time - events[i].prev_time;
 
-                        events[i].avghz = 0;
+                if(timediff != 0)
+                    hz = 1000000ULL / timediff;
 
-                        for(j = 0; j < HZ_LIST; j++) {
-                            events[i].avghz += events[i].hz[j];
-                        }
+                if(hz > 0) {
+                    unsigned j, maxavg;
 
-                        events[i].avghz /= (events[i].count > HZ_LIST) ? HZ_LIST : events[i].count;
+                    events[i].count++;
+                    events[i].hz[events[i].count & (HZ_LIST - 1)] = hz;
 
-                        if(verbose) printf("%s: Latest % 5iHz, Average % 5iHz\n", events[i].name, hz, events[i].avghz);
+                    events[i].avghz = 0;
+
+                    maxavg = (events[i].count > HZ_LIST) ? HZ_LIST : events[i].count;
+
+                    for(j = 0; j < maxavg; j++) {
+                        events[i].avghz += events[i].hz[j];
                     }
 
-                    events[i].prvtime = time;
+                    events[i].avghz /= maxavg;
+
+                    if(verbose) printf("%s: Latest % 5iHz, Average % 5iHz\n", events[i].name, hz, events[i].avghz);
                 }
+
+                events[i].prev_time = time;
             }
         }
     }
 
-    for(i = 0; i < EVENTS; i++) {
+    for(i = 0; i < max_event; i++) {
         if(events[i].fd != -1) {
             if (events[i].avghz != 0) {
                 printf("\nAverage for %s: % 5iHz\n", events[i].name, events[i].avghz);