/*************************************************************************** * CVSID: $Id$ * * addon-rfkill-killswitch.c: * Copyright (C) 2008 Danny Kukawka * * Licensed under the Academic Free License version 2.1 * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program 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 St, Fifth Floor, Boston, MA 02110-1301 USA * **************************************************************************/ #ifdef HAVE_CONFIG_H # include #endif #include #include #include #include #include #include #include #include #include #include #include #include #include "libhal/libhal.h" #include "../../logger.h" #include "../../util_helper.h" #include "../../util_helper_priv.h" static GMainLoop *gmain = NULL; static LibHalContext *ctx = NULL; static GHashTable *rfkills = NULL; /* Getting status of the killswitch */ static int get_killswitch (const char *udi) { FILE *f; char buf[64]; char path[256]; char *sysfs_path; int kill_status; int ret = -1; f = NULL; if (!g_hash_table_lookup_extended (rfkills, udi, NULL, (gpointer) &sysfs_path)) { return -1; } snprintf (path, sizeof (path), "%s/state", sysfs_path); if ((f = fopen (path, "r")) == NULL) { HAL_WARNING(("Could not read killswitch status from '%s' for device '%s'", path, udi)); return -1; } if (fgets (buf, sizeof (buf), f) == NULL) { HAL_ERROR (("Cannot read from '%s' for device '%s'", path, udi)); goto out; } errno = 0; kill_status = strtol (buf, NULL, 10); if (errno == 0) { HAL_DEBUG (("Got '%d' from sysfs interface for device '%s'.", kill_status, udi)); switch(kill_status) { case 1: /* RFKILL_STATE_UNBLOCKED (deprecated: RFKILL_STATE_ON): Radio output allowed */ ret = 1; break; case 0: /* RFKILL_STATE_SOFT_BLOCKED (deprecated: RFKILL_STATE_OFF): Radio output blocked */ case 2: /* RFKILL_STATE_HARD_BLOCKED: Output blocked, non-overrideable via sysfs */ ret = 0; break; default: break; } } out: if (f != NULL) fclose (f); return ret; } /* Setting status of the killswitch */ static int set_killswitch (const char *udi, gboolean status) { FILE *f; int ret; char path[256]; char *sysfs_path; if (!g_hash_table_lookup_extended (rfkills, udi, NULL, (gpointer) &sysfs_path)) { return -1; } snprintf (path, sizeof (path), "%s/state", sysfs_path); if ((f = fopen (path, "w")) == NULL) { HAL_WARNING(("Could not open '%s' for device '%s'", path, udi)); return -1; } if (status) { ret = fputs ("1", f); } else { ret = fputs ("0", f); } if (f != NULL) fclose (f); if (ret == EOF) { HAL_WARNING(("Couldn't write status to '%s' for device '%s'", path, udi)); ret = -1; } else { int current_state = get_killswitch(udi); if ((status && current_state) || (!status && !current_state)) { ret = 0; } else { HAL_DEBUG (("Could not set the state (%d) to sysfs for device '%s', current state is %d.", status, udi, current_state)); ret = -1; } } return ret; } /* DBus filter function */ static DBusHandlerResult filter_function (DBusConnection *connection, DBusMessage *message, void *userdata) { DBusError err; DBusMessage *reply; const char *_udi; char *type; char *action; char *sysfs_path; if ((_udi = dbus_message_get_path (message)) == NULL) { HAL_DEBUG (("Couldn't get the udi for this call, ignore it.")); return DBUS_HANDLER_RESULT_HANDLED; } else { if(!g_hash_table_lookup_extended (rfkills, _udi, NULL, (gpointer *) &sysfs_path)) { HAL_DEBUG (("This device (%s) isn't yet handled by the addon.", _udi)); return DBUS_HANDLER_RESULT_HANDLED; } } dbus_error_init (&err); if ((type = libhal_device_get_property_string (ctx, _udi, "killswitch.type", &err)) == NULL) { HAL_DEBUG (("Couldn't get the type of the killswitch device (%s). Ignore call.", _udi)); LIBHAL_FREE_DBUS_ERROR (&err); return DBUS_HANDLER_RESULT_HANDLED; } action = g_strdup_printf ("org.freedesktop.hal.killswitch.%s", type); libhal_free_string (type); if (!check_priv (ctx, connection, message, dbus_message_get_path (message), action)) { HAL_DEBUG(("User don't have the permissions to call the interface")); return DBUS_HANDLER_RESULT_HANDLED; } reply = NULL; if (dbus_message_is_method_call (message, "org.freedesktop.Hal.Device.KillSwitch", "SetPower")) { gboolean status; if (dbus_message_get_args (message, &err, DBUS_TYPE_BOOLEAN, &status, DBUS_TYPE_INVALID)) { int return_code = 0; int set; set = set_killswitch (_udi, status); reply = dbus_message_new_method_return (message); if (reply == NULL) goto error; if (set != 0) return_code = 1; dbus_message_append_args (reply, DBUS_TYPE_INT32, &return_code, DBUS_TYPE_INVALID); dbus_connection_send (connection, reply, NULL); } } else if (dbus_message_is_method_call (message, "org.freedesktop.Hal.Device.KillSwitch", "GetPower")) { int status; if (dbus_message_get_args (message, &err, DBUS_TYPE_INVALID)) { status = get_killswitch(_udi); reply = dbus_message_new_method_return (message); if (reply == NULL) goto error; dbus_message_append_args (reply, DBUS_TYPE_INT32, &status, DBUS_TYPE_INVALID); dbus_connection_send (connection, reply, NULL); } } error: if (reply != NULL) dbus_message_unref (reply); LIBHAL_FREE_DBUS_ERROR (&err); return DBUS_HANDLER_RESULT_HANDLED; } static void add_device (LibHalContext *ctx, const char *udi, const LibHalPropertySet *properties) { DBusError err; DBusConnection *dbus_connection; const char* sysfs_path; static gboolean initialized = FALSE; if ((sysfs_path = libhal_ps_get_string (properties, "linux.sysfs_path")) == NULL) { HAL_ERROR(("%s has no property linux.sysfs_path", udi)); return; } /* claim the interface */ if ((dbus_connection = libhal_ctx_get_dbus_connection(ctx)) == NULL) { HAL_WARNING (("Cannot get DBus connection")); return; } if (!initialized) { dbus_connection_add_filter (dbus_connection, filter_function, NULL, NULL); initialized = TRUE; } dbus_error_init (&err); if (!libhal_device_claim_interface (ctx, udi, "org.freedesktop.Hal.Device.KillSwitch", " \n" " \n" " \n" " \n" " \n" " \n" " \n", &err)) { HAL_ERROR (("Cannot claim interface 'org.freedesktop.Hal.Device.KillSwitch'")); LIBHAL_FREE_DBUS_ERROR (&err); return; } g_hash_table_insert (rfkills, g_strdup(udi), g_strdup(sysfs_path)); } static void remove_device (LibHalContext *ctx, const char *udi, const LibHalPropertySet *properties) { gpointer sysfs_path; gboolean handling_udi; HAL_DEBUG (("Removing channel for '%s'", udi)); handling_udi = g_hash_table_lookup_extended (rfkills, udi, NULL, &sysfs_path); if (!handling_udi) { HAL_ERROR(("DeviceRemove called for unknown device: '%s'.", udi)); return; } g_hash_table_remove (rfkills, udi); if (g_hash_table_size (rfkills) == 0) { HAL_INFO(("no more devices, exiting")); g_main_loop_quit (gmain); } } int main (int argc, char *argv[]) { DBusConnection *dbus_connection; DBusError error; const char *commandline; hal_set_proc_title_init (argc, argv); setup_logger (); dbus_error_init (&error); if ((ctx = libhal_ctx_init_direct (&error)) == NULL) { HAL_WARNING (("Unable to init libhal context")); goto out; } if ((dbus_connection = libhal_ctx_get_dbus_connection(ctx)) == NULL) { HAL_WARNING (("Cannot get DBus connection")); goto out; } if ((commandline = getenv ("SINGLETON_COMMAND_LINE")) == NULL) { HAL_WARNING (("SINGLETON_COMMAND_LINE not set")); goto out; } libhal_ctx_set_singleton_device_added (ctx, add_device); libhal_ctx_set_singleton_device_removed (ctx, remove_device); dbus_connection_setup_with_g_main (dbus_connection, NULL); dbus_connection_set_exit_on_disconnect (dbus_connection, 0); if (!libhal_device_singleton_addon_is_ready (ctx, commandline, &error)) { goto out; } rfkills = g_hash_table_new_full (g_str_hash, g_str_equal, g_free, NULL); gmain = g_main_loop_new (NULL, FALSE); g_main_loop_run (gmain); return 0; out: HAL_DEBUG (("An error occured, exiting cleanly")); LIBHAL_FREE_DBUS_ERROR (&error); if (ctx != NULL) { libhal_ctx_shutdown (ctx, &error); LIBHAL_FREE_DBUS_ERROR (&error); libhal_ctx_free (ctx); } return 0; }