hald/solaris/sysevent.c

	sysevent.c revision 18c2aff776a775d34a4c9893a4c72e0434d68e36
/***************************************************************************
 *
 * sysevent.c : Solaris sysevents
 *
 * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 *
 * Licensed under the Academic Free License version 2.1
 *
 **************************************************************************/

#pragma ident   "%Z%%M% %I% %E% SMI"

#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <fcntl.h>
#include <sys/dkio.h>
#include <sys/stat.h>
#include <libdevinfo.h>
#include <libsysevent.h>
#include <sys/sysevent/dev.h>
#include <glib.h>

#include "../osspec.h"
#include "../logger.h"
#include "../hald.h"
#include "../hald_dbus.h"
#include "../device_info.h"
#include "../util.h"
#include "osspec_solaris.h"
#include "hotplug.h"
#include "devinfo.h"
#include "devinfo_storage.h"
#include "sysevent.h"

#ifndef ESC_LOFI
#define ESC_LOFI "lofi"
#endif

static void sysevent_dev_handler(sysevent_t *);
static gboolean sysevent_iochannel_data(GIOChannel *, GIOCondition, gpointer);
static void sysevent_dev_add(gchar *, gchar *);
static void sysevent_dev_remove(gchar *, gchar *);
static void sysevent_dev_branch(gchar *);
static void sysevent_lofi_add(gchar *, gchar *);
static void sysevent_lofi_remove(gchar *, gchar *);

static sysevent_handle_t    *shp;

static int sysevent_pipe_fds[2];
static GIOChannel *sysevent_iochannel;
static guint sysevent_source_id;

gboolean
sysevent_init(void)
{
    GError *err = NULL;
    const char  *subcl[2];

        /*
     * pipe used to serialize sysevents through the main loop
     */
        if (pipe (sysevent_pipe_fds) != 0) {
                HAL_INFO (("pipe() failed errno=%d", errno));
        return (FALSE);
        }
        sysevent_iochannel = g_io_channel_unix_new (sysevent_pipe_fds[0]);
    if (sysevent_iochannel == NULL) {
                HAL_INFO (("g_io_channel_unix_new failed"));
        return (FALSE);
    }
    g_io_channel_set_flags (sysevent_iochannel, G_IO_FLAG_NONBLOCK, &err);
        sysevent_source_id = g_io_add_watch (
                sysevent_iochannel, G_IO_IN, sysevent_iochannel_data, NULL);

    shp = sysevent_bind_handle(sysevent_dev_handler);
    if (shp == NULL) {
        HAL_INFO (("sysevent_bind_handle failed %d", errno));
        return (FALSE);
    }

    subcl[0] = ESC_DISK;
    subcl[1] = ESC_LOFI;
    if (sysevent_subscribe_event(shp, EC_DEV_ADD, subcl, 2) != 0) {
        HAL_INFO (("subscribe(dev_add) failed %d", errno));
        sysevent_unbind_handle(shp);
        return (FALSE);
    }
    if (sysevent_subscribe_event(shp, EC_DEV_REMOVE, subcl, 2) != 0) {
        HAL_INFO (("subscribe(dev_remove) failed %d", errno));
        sysevent_unbind_handle(shp);
        return (FALSE);
    }

    subcl[0] = ESC_DEV_BRANCH_REMOVE;
    if (sysevent_subscribe_event(shp, EC_DEV_BRANCH, subcl, 1) != 0) {
        HAL_INFO (("subscribe(dev_branch) failed %d", errno));
        sysevent_unbind_handle(shp);
        return (FALSE);
    }

    return (B_TRUE);
}

void
sysevent_fini(void)
{
    sysevent_unbind_handle(shp);
    shp = NULL;
}

static void
sysevent_dev_handler(sysevent_t *ev)
{
    char        *class;
    char        *subclass;
    nvlist_t    *attr_list;
    char        *phys_path;
    char        *dev_name;
    char        s[1024];
    ssize_t     nwritten;

    if ((class = sysevent_get_class_name(ev)) == NULL)
        return;

    if ((subclass = sysevent_get_subclass_name(ev)) == NULL)
        return;

    if (sysevent_get_attr_list(ev, &attr_list) != 0)
        return;

    if (nvlist_lookup_string(attr_list, DEV_PHYS_PATH, &phys_path) != 0)
        goto out;

    if (nvlist_lookup_string(attr_list, DEV_NAME, &dev_name) != 0)
        dev_name = "";

    snprintf(s, sizeof (s), "%s %s %s %s\n",
        class, subclass, phys_path, dev_name);
    nwritten = write(sysevent_pipe_fds[1], s, strlen(s) + 1);

    HAL_INFO (("sysevent_dev_handler: wrote %d bytes", nwritten));

out:
    nvlist_free(attr_list);
}

static gboolean
sysevent_iochannel_data (GIOChannel *source,
                    GIOCondition condition,
                    gpointer user_data)
{
        GError *err = NULL;
    gchar *s = NULL;
    gsize len;
    int matches;
    gchar class[1024];
    gchar subclass[1024];
    gchar phys_path[1024];
    gchar dev_name[1024];

    HAL_INFO (("sysevent_iochannel_data"));

    while (g_io_channel_read_line (sysevent_iochannel, &s, &len, NULL,
                    &err) == G_IO_STATUS_NORMAL) {
        if (len == 0) {
            break;
        }

        class[0] = subclass[0] = phys_path[0] = dev_name[0] = '\0';
        matches = sscanf(s, "%s %s %s %s", class, subclass, phys_path, dev_name);
        g_free (s);
        s = NULL;
        if (matches < 3) {
            continue;
        }
        HAL_INFO (("sysevent: class=%s, sub=%s", class, subclass));

        if (strcmp(class, EC_DEV_ADD) == 0) {
            if (strcmp(subclass, ESC_DISK) == 0) {
                sysevent_dev_add(phys_path, dev_name);
            } else if (strcmp(subclass, ESC_LOFI) == 0) {
                sysevent_lofi_add(phys_path, dev_name);
            }
        } else if (strcmp(class, EC_DEV_REMOVE) == 0) {
            if (strcmp(subclass, ESC_DISK) == 0) {
                sysevent_dev_remove(phys_path, dev_name);
            } else if (strcmp(subclass, ESC_LOFI) == 0) {
                sysevent_lofi_remove(phys_path, dev_name);
            }
        } else if (strcmp(class, EC_DEV_BRANCH) == 0) {
            sysevent_dev_branch(phys_path);
        }
    }

    if (err) {
        g_error_free (err);
    }

    return (TRUE);
}

static void
sysevent_dev_add(gchar *devfs_path, gchar *name)
{
    gchar   *parent_devfs_path, *hotplug_devfs_path;
    HalDevice *parent;

    HAL_INFO (("dev_add: %s %s", name, devfs_path));

        parent = hal_util_find_closest_ancestor (devfs_path, &parent_devfs_path, &hotplug_devfs_path);
    if (parent == NULL) {
        return;
    }

    HAL_INFO (("dev_add: parent=%s", parent_devfs_path));
    HAL_INFO (("dev_add: real=%s", hotplug_devfs_path));

    devinfo_add (parent, hotplug_devfs_path);

    g_free (parent_devfs_path);
    g_free (hotplug_devfs_path);

    hotplug_event_process_queue ();
}

static void
sysevent_dev_remove(gchar *devfs_path, gchar *name)
{
    HAL_INFO (("dev_remove: %s %s", name, devfs_path));

    devinfo_remove_branch (devfs_path, NULL);
    hotplug_event_process_queue ();
}

static void
sysevent_dev_branch(gchar *devfs_path)
{
    HAL_INFO (("branch_remove: %s", devfs_path));

    devinfo_remove_branch (devfs_path, NULL);
    hotplug_event_process_queue ();
}

static void
sysevent_lofi_add(gchar *devfs_path, gchar *name)
{
    di_node_t node;
    const char *parent_udi;
    HalDevice *d, *parent;

    HAL_INFO (("lofi_add: %s %s", name, devfs_path));

    if ((d = hal_device_store_match_key_value_string (hald_get_gdl (),
        "solaris.devfs_path", devfs_path)) == NULL) {
        HAL_INFO (("device not found in GDL %s", devfs_path));
        return;
    }
    parent_udi = hal_device_property_get_string (d, "info.parent");
    if ((parent_udi == NULL) || (strlen(parent_udi) == 0)) {
        HAL_INFO (("parent not found in GDL %s", parent_udi));
        return;
    }
    if ((parent = hal_device_store_match_key_value_string (hald_get_gdl (),
        "info.udi", parent_udi)) == NULL) {
        HAL_INFO (("parent not found in GDL %s", parent_udi));
        return;
    }

    if ((node = di_init (devfs_path, DINFOCPYALL)) == DI_NODE_NIL) {
        HAL_INFO (("device not found in devinfo %s", devfs_path));
        return;
    }

    HAL_INFO (("device %s parent %s", d->udi, parent_udi));
    devinfo_lofi_add_major (parent, node, devfs_path, NULL, TRUE, d);

    di_fini (node);

    hotplug_event_process_queue ();
}

static void
sysevent_lofi_remove(gchar *parent_devfs_path, gchar *name)
{
    devinfo_lofi_remove_minor(parent_devfs_path, name);
    hotplug_event_process_queue ();
}