ncd: modules: add sys.watch_input

blog_channels.txt

@@ -34,6 +34,7 @@ ncd_net_ipv4_addr 4
 ncd_net_ipv4_route 4
 ncd_net_ipv4_dhcp 4
 ncd_net_watch_interfaces 4
+ncd_sys_watch_input 4
 ncd_sys_evdev 4
 ncd_sys_watch_directory 4
 StreamPeerIO 4

generated/blog_channel_ncd_sys_watch_input.h

@@ -0,0 +1,4 @@
+#ifdef BLOG_CURRENT_CHANNEL
+#undef BLOG_CURRENT_CHANNEL
+#endif
+#define BLOG_CURRENT_CHANNEL BLOG_CHANNEL_ncd_sys_watch_input

generated/blog_channels_defines.h

@@ -34,52 +34,53 @@
 #define BLOG_CHANNEL_ncd_net_ipv4_route 33
 #define BLOG_CHANNEL_ncd_net_ipv4_dhcp 34
 #define BLOG_CHANNEL_ncd_net_watch_interfaces 35
-#define BLOG_CHANNEL_ncd_sys_evdev 36
-#define BLOG_CHANNEL_ncd_sys_watch_directory 37
-#define BLOG_CHANNEL_StreamPeerIO 38
-#define BLOG_CHANNEL_DatagramPeerIO 39
-#define BLOG_CHANNEL_BReactor 40
-#define BLOG_CHANNEL_BSignal 41
-#define BLOG_CHANNEL_FragmentProtoAssembler 42
-#define BLOG_CHANNEL_BPredicate 43
-#define BLOG_CHANNEL_ServerConnection 44
-#define BLOG_CHANNEL_Listener 45
-#define BLOG_CHANNEL_DataProto 46
-#define BLOG_CHANNEL_FrameDecider 47
-#define BLOG_CHANNEL_BSocksClient 48
-#define BLOG_CHANNEL_BDHCPClientCore 49
-#define BLOG_CHANNEL_BDHCPClient 50
-#define BLOG_CHANNEL_NCDIfConfig 51
-#define BLOG_CHANNEL_BUnixSignal 52
-#define BLOG_CHANNEL_BProcess 53
-#define BLOG_CHANNEL_PRStreamSink 54
-#define BLOG_CHANNEL_PRStreamSource 55
-#define BLOG_CHANNEL_PacketProtoDecoder 56
-#define BLOG_CHANNEL_DPRelay 57
-#define BLOG_CHANNEL_BThreadWork 58
-#define BLOG_CHANNEL_DPReceive 59
-#define BLOG_CHANNEL_BInputProcess 60
-#define BLOG_CHANNEL_NCDUdevMonitorParser 61
-#define BLOG_CHANNEL_NCDUdevMonitor 62
-#define BLOG_CHANNEL_NCDUdevCache 63
-#define BLOG_CHANNEL_NCDUdevManager 64
-#define BLOG_CHANNEL_BTime 65
-#define BLOG_CHANNEL_BEncryption 66
-#define BLOG_CHANNEL_SPProtoDecoder 67
-#define BLOG_CHANNEL_LineBuffer 68
-#define BLOG_CHANNEL_BTap 69
-#define BLOG_CHANNEL_lwip 70
-#define BLOG_CHANNEL_NCDConfigParser 71
-#define BLOG_CHANNEL_nsskey 72
-#define BLOG_CHANNEL_addr 73
-#define BLOG_CHANNEL_PasswordListener 74
-#define BLOG_CHANNEL_NCDInterfaceMonitor 75
-#define BLOG_CHANNEL_NCDRfkillMonitor 76
-#define BLOG_CHANNEL_udpgw 77
-#define BLOG_CHANNEL_UdpGwClient 78
-#define BLOG_CHANNEL_SocksUdpGwClient 79
-#define BLOG_CHANNEL_BNetwork 80
-#define BLOG_CHANNEL_BConnection 81
-#define BLOG_CHANNEL_BSSLConnection 82
-#define BLOG_CHANNEL_BDatagram 83
-#define BLOG_NUM_CHANNELS 84
+#define BLOG_CHANNEL_ncd_sys_watch_input 36
+#define BLOG_CHANNEL_ncd_sys_evdev 37
+#define BLOG_CHANNEL_ncd_sys_watch_directory 38
+#define BLOG_CHANNEL_StreamPeerIO 39
+#define BLOG_CHANNEL_DatagramPeerIO 40
+#define BLOG_CHANNEL_BReactor 41
+#define BLOG_CHANNEL_BSignal 42
+#define BLOG_CHANNEL_FragmentProtoAssembler 43
+#define BLOG_CHANNEL_BPredicate 44
+#define BLOG_CHANNEL_ServerConnection 45
+#define BLOG_CHANNEL_Listener 46
+#define BLOG_CHANNEL_DataProto 47
+#define BLOG_CHANNEL_FrameDecider 48
+#define BLOG_CHANNEL_BSocksClient 49
+#define BLOG_CHANNEL_BDHCPClientCore 50
+#define BLOG_CHANNEL_BDHCPClient 51
+#define BLOG_CHANNEL_NCDIfConfig 52
+#define BLOG_CHANNEL_BUnixSignal 53
+#define BLOG_CHANNEL_BProcess 54
+#define BLOG_CHANNEL_PRStreamSink 55
+#define BLOG_CHANNEL_PRStreamSource 56
+#define BLOG_CHANNEL_PacketProtoDecoder 57
+#define BLOG_CHANNEL_DPRelay 58
+#define BLOG_CHANNEL_BThreadWork 59
+#define BLOG_CHANNEL_DPReceive 60
+#define BLOG_CHANNEL_BInputProcess 61
+#define BLOG_CHANNEL_NCDUdevMonitorParser 62
+#define BLOG_CHANNEL_NCDUdevMonitor 63
+#define BLOG_CHANNEL_NCDUdevCache 64
+#define BLOG_CHANNEL_NCDUdevManager 65
+#define BLOG_CHANNEL_BTime 66
+#define BLOG_CHANNEL_BEncryption 67
+#define BLOG_CHANNEL_SPProtoDecoder 68
+#define BLOG_CHANNEL_LineBuffer 69
+#define BLOG_CHANNEL_BTap 70
+#define BLOG_CHANNEL_lwip 71
+#define BLOG_CHANNEL_NCDConfigParser 72
+#define BLOG_CHANNEL_nsskey 73
+#define BLOG_CHANNEL_addr 74
+#define BLOG_CHANNEL_PasswordListener 75
+#define BLOG_CHANNEL_NCDInterfaceMonitor 76
+#define BLOG_CHANNEL_NCDRfkillMonitor 77
+#define BLOG_CHANNEL_udpgw 78
+#define BLOG_CHANNEL_UdpGwClient 79
+#define BLOG_CHANNEL_SocksUdpGwClient 80
+#define BLOG_CHANNEL_BNetwork 81
+#define BLOG_CHANNEL_BConnection 82
+#define BLOG_CHANNEL_BSSLConnection 83
+#define BLOG_CHANNEL_BDatagram 84
+#define BLOG_NUM_CHANNELS 85

generated/blog_channels_list.h

@@ -34,6 +34,7 @@
 {.name = "ncd_net_ipv4_route", .loglevel = 4},
 {.name = "ncd_net_ipv4_dhcp", .loglevel = 4},
 {.name = "ncd_net_watch_interfaces", .loglevel = 4},
+{.name = "ncd_sys_watch_input", .loglevel = 4},
 {.name = "ncd_sys_evdev", .loglevel = 4},
 {.name = "ncd_sys_watch_directory", .loglevel = 4},
 {.name = "StreamPeerIO", .loglevel = 4},

ncd/CMakeLists.txt

@@ -60,6 +60,7 @@ add_executable(badvpn-ncd
     modules/net_ipv4_route.c
     modules/net_ipv4_dhcp.c
     modules/net_watch_interfaces.c
+    modules/sys_watch_input.c
     ${NCD_ADDITIONAL_SOURCES}
 )
 target_link_libraries(badvpn-ncd system flow flowextra dhcpclient ncdconfig udevmonitor)

ncd/modules/modules.h

@@ -60,6 +60,7 @@ extern const struct NCDModuleGroup ncdmodule_net_ipv4_addr;
 extern const struct NCDModuleGroup ncdmodule_net_ipv4_route;
 extern const struct NCDModuleGroup ncdmodule_net_ipv4_dhcp;
 extern const struct NCDModuleGroup ncdmodule_net_watch_interfaces;
+extern const struct NCDModuleGroup ncdmodule_sys_watch_input;
 #ifdef BADVPN_USE_LINUX_INPUT
 extern const struct NCDModuleGroup ncdmodule_sys_evdev;
 #endif
@@ -101,6 +102,7 @@ static const struct NCDModuleGroup *ncd_modules[] = {
     &ncdmodule_net_ipv4_route,
     &ncdmodule_net_ipv4_dhcp,
     &ncdmodule_net_watch_interfaces,
+    &ncdmodule_sys_watch_input,
 #ifdef BADVPN_USE_LINUX_INPUT
     &ncdmodule_sys_evdev,
 #endif

ncd/modules/sys_watch_input.c

@@ -0,0 +1,483 @@
+/**
+ * @file sys_watch_input.c
+ * @author Ambroz Bizjak <ambrop7@gmail.com>
+ * 
+ * @section LICENSE
+ * 
+ * This file is part of BadVPN.
+ * 
+ * BadVPN is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2
+ * as published by the Free Software Foundation.
+ * 
+ * BadVPN 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 General Public License for more details.
+ * 
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ * 
+ * @section DESCRIPTION
+ * 
+ * Input device watcher.
+ * 
+ * Synopsis: sys.watch_input(string devnode_type)
+ * Description: reports input device events. Transitions up when an event is detected, and
+ *   goes down waiting for the next event when sys.watch_input::nextevent() is called.
+ *   On startup, "added" events are reported for existing input devices.
+ * Arguments:
+ *   string devnode_type - device node type, for example "event", "mouse" or "js".
+ * Variables:
+ *   string event_type - what happened with the input device: "added" or "removed"
+ *   string devname - device node path
+ *   string device_type - input device type, "tablet", "joystick", "touchscreen", "mouse",
+ *     "touchpad", "key", "keyboard" or "unknown"
+ * 
+ * Synopsis: sys.watch_input::nextevent()
+ * Description: makes the watch_input module transition down in order to report the next event.
+ */
+
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+
+#include <misc/debug.h>
+#include <misc/offset.h>
+#include <structure/LinkedList1.h>
+#include <udevmonitor/NCDUdevManager.h>
+#include <ncd/NCDModule.h>
+#include <ncd/modules/event_template.h>
+
+#include <generated/blog_channel_ncd_sys_watch_input.h>
+
+#define ModuleLog(i, ...) NCDModuleInst_Backend_Log((i), BLOG_CURRENT_CHANNEL, __VA_ARGS__)
+
+struct device {
+    char *devname;
+    char *devpath;
+    BStringMap removed_map;
+    LinkedList1Node devices_list_node;
+};
+
+struct instance {
+    NCDModuleInst *i;
+    char *devnode_type;
+    NCDUdevClient client;
+    LinkedList1 devices_list;
+    event_template templ;
+};
+
+struct nextevent_instance {
+    NCDModuleInst *i;
+};
+
+static void templ_func_free (struct instance *o);
+
+struct device * find_device_by_devname (struct instance *o, const char *devname)
+{
+    LinkedList1Node *list_node = LinkedList1_GetFirst(&o->devices_list);
+    while (list_node) {
+        struct device *device = UPPER_OBJECT(list_node, struct device, devices_list_node);
+        if (!strcmp(device->devname, devname)) {
+            return device;
+        }
+        list_node = LinkedList1Node_Next(list_node);
+    }
+    
+    return NULL;
+}
+
+struct device * find_device_by_devpath (struct instance *o, const char *devpath)
+{
+    LinkedList1Node *list_node = LinkedList1_GetFirst(&o->devices_list);
+    while (list_node) {
+        struct device *device = UPPER_OBJECT(list_node, struct device, devices_list_node);
+        if (!strcmp(device->devpath, devpath)) {
+            return device;
+        }
+        list_node = LinkedList1Node_Next(list_node);
+    }
+    
+    return NULL;
+}
+
+static void free_device (struct instance *o, struct device *device, int have_removed_map)
+{
+    // remove from devices list
+    LinkedList1_Remove(&o->devices_list, &device->devices_list_node);
+    
+    // free removed map
+    if (have_removed_map) {
+        BStringMap_Free(&device->removed_map);
+    }
+    
+    // free devpath
+    free(device->devpath);
+    
+    // free devname
+    free(device->devname);
+    
+    // free structure
+    free(device);
+}
+
+static int make_event_map (struct instance *o, int added, const char *devname, const char *device_type, BStringMap *out_map)
+{
+    // init map
+    BStringMap map;
+    BStringMap_Init(&map);
+    
+    // set type
+    if (!BStringMap_Set(&map, "event_type", (added ? "added" : "removed"))) {
+        ModuleLog(o->i, BLOG_ERROR, "BStringMap_Set failed");
+        goto fail1;
+    }
+    
+    // set devname
+    if (!BStringMap_Set(&map, "devname", devname)) {
+        ModuleLog(o->i, BLOG_ERROR, "BStringMap_Set failed");
+        goto fail1;
+    }
+    
+    // set device type
+    if (!BStringMap_Set(&map, "device_type", device_type)) {
+        ModuleLog(o->i, BLOG_ERROR, "BStringMap_Set failed");
+        goto fail1;
+    }
+    
+    *out_map = map;
+    return 1;
+    
+fail1:
+    BStringMap_Free(&map);
+    return 0;
+}
+
+static int devname_is_type (const char *devname, const char *devname_type)
+{
+    // skip digits at the end
+    size_t i;
+    for (i = strlen(devname); i > 0; i--) {
+        if (!isdigit(devname[i - 1])) {
+            break;
+        }
+    }
+    
+    // check if devname_type precedes skipped digits
+    for (size_t j = strlen(devname_type); j > 0; j--) {
+        if (!(i > 0 && devname[i - 1] == devname_type[j - 1])) {
+            return 0;
+        }
+        i--;
+    }
+    
+    // check if slash precedes devname_type
+    if (!(i > 0 && devname[i - 1] == '/')) {
+        return 0;
+    }
+    
+    return 1;
+}
+
+static void queue_event (struct instance *o, BStringMap map)
+{
+    // pass event to template
+    int was_empty;
+    event_template_queue(&o->templ, map, &was_empty);
+    
+    // if event queue was empty, stop receiving udev events
+    if (was_empty) {
+        NCDUdevClient_Pause(&o->client);
+    }
+}
+
+static void add_device (struct instance *o, const char *devname, const char *devpath, const char *device_type)
+{
+    ASSERT(!find_device_by_devname(o, devname))
+    ASSERT(!find_device_by_devpath(o, devpath))
+    
+    // allocate structure
+    struct device *device = malloc(sizeof(*device));
+    if (!device) {
+        ModuleLog(o->i, BLOG_ERROR, "malloc failed");
+        goto fail0;
+    }
+    
+    // init devname
+    if (!(device->devname = strdup(devname))) {
+        ModuleLog(o->i, BLOG_ERROR, "strdup failed");
+        goto fail1;
+    }
+    
+    // init devpath
+    if (!(device->devpath = strdup(devpath))) {
+        ModuleLog(o->i, BLOG_ERROR, "strdup failed");
+        goto fail2;
+    }
+    
+    // init removed map
+    if (!make_event_map(o, 0, devname, device_type, &device->removed_map)) {
+        ModuleLog(o->i, BLOG_ERROR, "make_event_map failed");
+        goto fail3;
+    }
+    
+    // init added map
+    BStringMap added_map;
+    if (!make_event_map(o, 1, devname, device_type, &added_map)) {
+        ModuleLog(o->i, BLOG_ERROR, "make_event_map failed");
+        goto fail4;
+    }
+    
+    // insert to devices list
+    LinkedList1_Append(&o->devices_list, &device->devices_list_node);
+    
+    // queue event
+    queue_event(o, added_map);
+    
+    return;
+    
+fail4:
+    BStringMap_Free(&device->removed_map);
+fail3:
+    free(device->devpath);
+fail2:
+    free(device->devname);
+fail1:
+    free(device);
+fail0:
+    ModuleLog(o->i, BLOG_ERROR, "failed to add device %s", devname);
+}
+
+static void remove_device (struct instance *o, struct device *device)
+{
+    queue_event(o, device->removed_map);
+    free_device(o, device, 0);
+}
+
+static void next_event (struct instance *o)
+{
+    event_template_assert_enabled(&o->templ);
+    
+    // order template to finish the current event
+    int is_empty;
+    event_template_dequeue(&o->templ, &is_empty);
+    
+    // if template has no events, continue udev events
+    if (is_empty) {
+        NCDUdevClient_Continue(&o->client);
+    }
+}
+
+static void client_handler (struct instance *o, char *devpath, int have_map, BStringMap map)
+{
+    // lookup existing device with this devpath
+    struct device *ex_device = find_device_by_devpath(o, devpath);
+    // lookup cache entry
+    const BStringMap *cache_map = NCDUdevManager_Query(o->i->umanager, devpath);
+    
+    if (!cache_map) {
+        if (ex_device) {
+            remove_device(o, ex_device);
+        }
+        goto out;
+    }
+    
+    const char *subsystem = BStringMap_Get(cache_map, "SUBSYSTEM");
+    const char *devname = BStringMap_Get(cache_map, "DEVNAME");
+    
+    if (!(subsystem && !strcmp(subsystem, "input") && devname && devname_is_type(devname, o->devnode_type))) {
+        if (ex_device) {
+            remove_device(o, ex_device);
+        }
+        goto out;
+    }
+    
+    if (ex_device && strcmp(ex_device->devname, devname)) {
+        remove_device(o, ex_device);
+        ex_device = NULL;
+    }
+    
+    if (!ex_device) {
+        struct device *ex_devname_device = find_device_by_devname(o, devname);
+        if (ex_devname_device) {
+            remove_device(o, ex_devname_device);
+        }
+        
+        // determine type
+        const char *device_type = "unknown";
+        if (BStringMap_Get(cache_map, "ID_INPUT_TABLET")) {
+            device_type = "tablet";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_JOYSTICK")) {
+            device_type = "joystick";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_TOUCHSCREEN")) {
+            device_type = "touchscreen";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_MOUSE")) {
+            device_type = "mouse";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_TOUCHPAD")) {
+            device_type = "touchpad";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_KEY")) {
+            device_type = "key";
+        }
+        else if (BStringMap_Get(cache_map, "ID_INPUT_KEYBOARD")) {
+            device_type = "keyboard";
+        }
+        
+        add_device(o, devname, devpath, device_type);
+    }
+    
+out:
+    free(devpath);
+    if (have_map) {
+        BStringMap_Free(&map);
+    }
+}
+
+static void func_new (NCDModuleInst *i)
+{
+    // allocate instance
+    struct instance *o = malloc(sizeof(*o));
+    if (!o) {
+        ModuleLog(i, BLOG_ERROR, "failed to allocate instance");
+        goto fail0;
+    }
+    NCDModuleInst_Backend_SetUser(i, o);
+    
+    // init arguments
+    o->i = i;
+    
+    // check arguments
+    NCDValue *devnode_type_arg;
+    if (!NCDValue_ListRead(o->i->args, 1, &devnode_type_arg)) {
+        ModuleLog(o->i, BLOG_ERROR, "wrong arity");
+        goto fail1;
+    }
+    if (NCDValue_Type(devnode_type_arg) != NCDVALUE_STRING) {
+        ModuleLog(o->i, BLOG_ERROR, "wrong type");
+        goto fail1;
+    }
+    o->devnode_type = NCDValue_StringValue(devnode_type_arg);
+    
+    // init client
+    NCDUdevClient_Init(&o->client, o->i->umanager, o, (NCDUdevClient_handler)client_handler);
+    
+    // init devices list
+    LinkedList1_Init(&o->devices_list);
+    
+    event_template_new(&o->templ, o->i, BLOG_CURRENT_CHANNEL, 3, o, (event_template_func_free)templ_func_free);
+    return;
+    
+fail1:
+    free(o);
+fail0:
+    NCDModuleInst_Backend_SetError(i);
+    NCDModuleInst_Backend_Event(i, NCDMODULE_EVENT_DEAD);
+}
+
+static void templ_func_free (struct instance *o)
+{
+    NCDModuleInst *i = o->i;
+    
+    // free devices
+    LinkedList1Node *list_node;
+    while (list_node = LinkedList1_GetFirst(&o->devices_list)) {
+        struct device *device = UPPER_OBJECT(list_node, struct device, devices_list_node);
+        free_device(o, device, 1);
+    }
+    
+    // free client
+    NCDUdevClient_Free(&o->client);
+    
+    // free instance
+    free(o);
+    
+    NCDModuleInst_Backend_Event(i, NCDMODULE_EVENT_DEAD);
+}
+
+static void func_die (void *vo)
+{
+    struct instance *o = vo;
+    event_template_die(&o->templ);
+}
+
+static int func_getvar (void *vo, const char *name, NCDValue *out)
+{
+    struct instance *o = vo;
+    return event_template_getvar(&o->templ, name, out);
+}
+
+static void nextevent_func_new (NCDModuleInst *i)
+{
+    // allocate instance
+    struct nextevent_instance *o = malloc(sizeof(*o));
+    if (!o) {
+        ModuleLog(i, BLOG_ERROR, "failed to allocate instance");
+        goto fail0;
+    }
+    NCDModuleInst_Backend_SetUser(i, o);
+    
+    // init arguments
+    o->i = i;
+    
+    // check arguments
+    if (!NCDValue_ListRead(o->i->args, 0)) {
+        ModuleLog(o->i, BLOG_ERROR, "wrong arity");
+        goto fail1;
+    }
+    
+    // get method object
+    struct instance *mo = i->method_object->inst_user;
+    event_template_assert_enabled(&mo->templ);
+    
+    // signal up.
+    // Do it before finishing the event so our process does not advance any further if
+    // we would be killed the event provider going down.
+    NCDModuleInst_Backend_Event(o->i, NCDMODULE_EVENT_UP);
+    
+    // wait for next event
+    next_event(mo);
+    
+    return;
+    
+fail1:
+    free(o);
+fail0:
+    NCDModuleInst_Backend_SetError(i);
+    NCDModuleInst_Backend_Event(i, NCDMODULE_EVENT_DEAD);
+}
+
+static void nextevent_func_die (void *vo)
+{
+    struct nextevent_instance *o = vo;
+    NCDModuleInst *i = o->i;
+    
+    // free instance
+    free(o);
+    
+    NCDModuleInst_Backend_Event(i, NCDMODULE_EVENT_DEAD);
+}
+
+static const struct NCDModule modules[] = {
+    {
+        .type = "sys.watch_input",
+        .func_new = func_new,
+        .func_die = func_die,
+        .func_getvar = func_getvar
+    }, {
+        .type = "sys.watch_input::nextevent",
+        .func_new = nextevent_func_new,
+        .func_die = nextevent_func_die
+    }, {
+        .type = NULL
+    }
+};
+
+const struct NCDModuleGroup ncdmodule_sys_watch_input = {
+    .modules = modules
+};