2013-09-26 17:14:40 +02:00

517 lines
15 KiB
C

/***************************************************************************
*
* addon-storage.c : watch removable media state changes
*
* Copyright 2006 Sun Microsystems, Inc. All rights reserved.
* Use is subject to license terms.
*
* Licensed under the Academic Free License version 2.1
*
**************************************************************************/
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#include <errno.h>
#include <string.h>
#include <strings.h>
#include <stdlib.h>
#include <stdio.h>
#include <syslog.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/wait.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/statvfs.h>
#include <sys/dkio.h>
#include <dev/scsipi/scsi_spc.h>
#include <dev/scsipi/scsipi_all.h>
#include <dev/scsipi/scsipi_cd.h>
#include <sys/scsiio.h>
#include <libhal.h>
#include <logger.h>
#define SLEEP_PERIOD 5
#define _EXPOSE_MMC
#include <sys/cdio.h>
enum discstate {
DISC_INSERTED,
DISC_EJECTED,
DISC_NONE,
DISC_UNKNOWN
};
static enum discstate
scsi_test_unit_ready (int fd)
{
struct scsi_test_unit_ready tur;
scsireq_t req;
memset(&tur, 0, sizeof(tur));
tur.opcode = SCSI_TEST_UNIT_READY;
memset(&req, 0, sizeof(req));
memcpy(req.cmd, &tur, sizeof(tur));
req.cmdlen = sizeof(tur);
req.databuf = NULL;
req.datalen = 0;
req.timeout = 10000;
req.flags = SCCMD_READ;
req.senselen = SENSEBUFLEN;
if (ioctl(fd, SCIOCCOMMAND, &req) == -1)
return DISC_UNKNOWN;
if (req.retsts == SCCMD_OK)
return DISC_INSERTED;
return DISC_EJECTED;
}
static void
my_dbus_error_free(DBusError *error)
{
if (dbus_error_is_set(error)) {
dbus_error_free(error);
}
}
static void
force_unmount (LibHalContext *ctx, const char *udi)
{
DBusError error;
DBusMessage *msg = NULL;
DBusMessage *reply = NULL;
char **options = NULL;
unsigned int num_options = 0;
DBusConnection *dbus_connection;
char *device_file;
dbus_error_init (&error);
dbus_connection = libhal_ctx_get_dbus_connection (ctx);
msg = dbus_message_new_method_call ("org.freedesktop.Hal", udi,
"org.freedesktop.Hal.Device.Volume",
"Unmount");
if (msg == NULL) {
HAL_DEBUG (("Could not create dbus message for %s", udi));
goto out;
}
options = calloc (1, sizeof (char *));
if (options == NULL) {
HAL_DEBUG (("Could not allocate options array"));
goto out;
}
device_file = libhal_device_get_property_string (ctx, udi, "block.device", &error);
if (device_file != NULL) {
libhal_free_string (device_file);
}
dbus_error_free (&error);
if (!dbus_message_append_args (msg,
DBUS_TYPE_ARRAY, DBUS_TYPE_STRING, &options, num_options,
DBUS_TYPE_INVALID)) {
HAL_DEBUG (("Could not append args to dbus message for %s", udi));
goto out;
}
if (!(reply = dbus_connection_send_with_reply_and_block (dbus_connection, msg, -1, &error))) {
HAL_DEBUG (("Unmount failed for %s: %s : %s\n", udi, error.name, error.message));
goto out;
}
if (dbus_error_is_set (&error)) {
HAL_DEBUG (("Unmount failed for %s\n%s : %s\n", udi, error.name, error.message));
goto out;
}
HAL_DEBUG (("Succesfully unmounted udi '%s'", udi));
out:
dbus_error_free (&error);
if (options != NULL)
free (options);
if (msg != NULL)
dbus_message_unref (msg);
if (reply != NULL)
dbus_message_unref (reply);
}
static void
unmount_childs (LibHalContext *ctx, const char *udi)
{
DBusError error;
int num_volumes;
char **volumes;
dbus_error_init (&error);
/* need to force unmount all partitions */
if ((volumes = libhal_manager_find_device_string_match (
ctx, "block.storage_device", udi, &num_volumes, &error)) != NULL) {
dbus_error_free (&error);
int i;
for (i = 0; i < num_volumes; i++) {
char *vol_udi;
vol_udi = volumes[i];
if (libhal_device_get_property_bool (ctx, vol_udi, "block.is_volume", &error)) {
dbus_error_free (&error);
if (libhal_device_get_property_bool (ctx, vol_udi, "volume.is_mounted", &error)) {
dbus_error_free (&error);
HAL_DEBUG (("Forcing unmount of child '%s'", vol_udi));
force_unmount (ctx, vol_udi);
}
}
}
libhal_free_string_array (volumes);
}
my_dbus_error_free (&error);
}
/** Check if a filesystem on a special device file is mounted
*
* @param device_file Special device file, e.g. /dev/cdrom
* @return TRUE iff there is a filesystem system mounted
* on the special device file
*/
static dbus_bool_t
is_mounted (const char *device_file)
{
int count;
struct statvfs *statvfs;
count = getmntinfo(&statvfs, ST_WAIT);
while (count-- > 0) {
if (strcmp(statvfs->f_mntfromname, device_file) == 0)
return TRUE;
}
return FALSE;
}
static void
close_device (int *fd)
{
if (*fd > 0) {
close (*fd);
*fd = -1;
}
}
/* XXX why not share this further */
static char const *
get_profile_typestring(int profile)
{
switch (profile) {
case 0x00 : return "unknown"; // "Unknown[0] profile";
case 0x01 : return "unknown"; // "Non removeable disc";
case 0x02 : return "unknown"; // "Removable disc";
case 0x03 : return "mo"; // Magneto Optical with sector erase";
case 0x04 : return "mo"; // "Magneto Optical write once";
case 0x05 : return "mo"; // "Advance Storage Magneto Optical";
case 0x08 : return "cd_rom"; // "CD-ROM"; no writing
case 0x09 : return "cd_r"; // "CD-R recordable";
case 0x0a : return "cd_rw"; // "CD-RW rewritable";
case 0x10 : return "dvd_rom"; // "DVD-ROM"; no writing
case 0x11 : return "dvd_r"; // "DVD-R sequential";
case 0x12 : return "dvd_ram"; // "DVD-RAM rewritable";
case 0x13 : return "dvd_rw"; // "DVD-RW restricted overwrite";
case 0x14 : return "dvd_rw"; // "DVD-RW sequential";
case 0x15 : return "dvd_r"; // "DVD-R dual layer sequential";
case 0x16 : return "dvd_r"; // "DVD-R dual layer jump";
case 0x17 : return "dvd_rw"; // "DVD-RW dual layer";
case 0x18 : return "unknown"; // "DVD-Download disc"; UNKNOWN
case 0x1a : return "dvd_plus_rw"; // "DVD+RW rewritable";
case 0x1b : return "dvd_plus_r"; // "DVD+R recordable";
case 0x20 : return "ddcd_rom"; // "DDCD readonly (retracted)"; no writing
case 0x21 : return "ddcd_r"; // "DDCD-R recordable (retracted)"; OK?
case 0x22 : return "ddcd_rw"; // "DDCD-RW rewritable (retracted)"; OK?
case 0x2a : return "dvd_plus_rw_dl";//"DVD+RW double layer";
case 0x2b : return "dvd_plus_r_dl";// "DVD+R double layer";
case 0x40 : return "bd_rom"; // "BD-ROM";
case 0x41 : return "bd_r"; // "BD-R Sequential Recording (SRM)";
case 0x42 : return "bd_r"; // "BD-R Random Recording (RRM)";
case 0x43 : return "bd_re"; // "BD-RE rewritable";
case 0x50 : return "hddvd_rom"; // "HD DVD-ROM (retracted)";
case 0x51 : return "hddvd_r"; // "HD DVD-R (retracted)";
case 0x52 : return "hddvd_ram"; // "HD DVD-RAM (retracted)";
case 0x53 : return "hddvd_rw"; // "HD DVD-RW (retracted)";
case 0x58 : return "hddvd_r_dl"; // "HD DVD-R dual layer (retracted)";
case 0x5a : return "hddvd_rw_dl"; // "HD DVD-RW dual layer (retracted)";
}
/* reserved */
return "unknown";
}
static void
set_volume_properties(int fd, LibHalContext *ctx, char *udi, int state)
{
struct mmc_discinfo di;
struct mmc_trackinfo ti;
struct volume_id *vid;
DBusError error;
uint64_t capacity;
char const *disc_type;
char *disc_fstype, *disc_label;
int has_audio, has_data, is_vcd, is_svcd, is_videodvd, is_appendable, is_blank, is_rewritable;
int tracknr, err;
disc_fstype = "";
disc_label = "";
disc_type = "unknown";
has_audio = has_data = is_vcd = is_svcd = is_videodvd = is_appendable = is_blank = is_rewritable = 0;
capacity = 0;
dbus_error_init (&error);
if (state == DISC_INSERTED) {
/* fetch new values */
memset(&di, 0, sizeof(struct mmc_discinfo));
err = ioctl(fd, MMCGETDISCINFO, &di);
if (!err) {
disc_type = get_profile_typestring(di.mmc_profile);
is_rewritable = di.mmc_cur & MMC_CAP_REWRITABLE;
is_blank = (di.disc_state == MMC_STATE_EMPTY);
is_appendable = (di.disc_state != MMC_STATE_FULL);
/* can't check is_videodvd, is_svcd, is_vcd (yet); use volume lib */
disc_fstype = "cd9660";
disc_label = "label";
vid = NULL;
#if 0
vid = volume_id_open_fd (fd);
if (vid) {
if (volume_id_probe_all (vid, 0, psize) == 0) {
hal_device_property_set_string (d, "volume.label", vid->label);
hal_device_property_set_string (d, "volume.partition.label", vid->label);
hal_device_property_set_string (d, "volume.uuid", vid->uuid);
hal_device_property_set_string (d, "volume.partition.uuid", vid->uuid);
}
volume_id_close (vid);
}
#endif
for (tracknr = di.first_track; tracknr <= di.last_track_last_session; tracknr++) {
memset(&ti, 0, sizeof(struct mmc_trackinfo));
ti.tracknr = tracknr;
err = ioctl(fd, MMCGETTRACKINFO, &ti);
if (err)
break;
if (!(ti.flags & MMC_TRACKINFO_BLANK)) {
if (ti.flags & MMC_TRACKINFO_DATA)
has_data = TRUE;
if (ti.flags & MMC_TRACKINFO_AUDIO)
has_audio = TRUE;
}
capacity += (ti.track_size + ti.free_blocks) * di.sector_size;
}
}
}
/* add volume properties (ignoring dbus errors) */
libhal_device_set_property_bool (ctx, udi, "volume.ignore", FALSE, &error); /* make visible */
libhal_device_set_property_bool (ctx, udi, "volume.is_mounted", FALSE, &error); /* XXX fixme XXX */
libhal_device_set_property_bool (ctx, udi, "volume.is_mounted_readonly", FALSE, &error); /* XXX fixme XXX */
libhal_device_set_property_string (ctx, udi, "volume.fsusage", "filesystem", &error);
libhal_device_set_property_string (ctx, udi, "volume.fstype", disc_fstype, &error);
libhal_device_set_property_string (ctx, udi, "volume.label", disc_label, &error);
libhal_device_set_property_string (ctx, udi, "volume.uuid", "", &error);
libhal_device_set_property_uint64 (ctx, udi, "volume.size", capacity, &error);
/* add volume.disc properties (ignoring dbus errors) */
libhal_device_set_property_bool (ctx, udi, "volume.disc.has_audio", has_audio, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.has_data", has_data, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_vcd", is_vcd, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_svcd", is_svcd, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_videodvd", is_videodvd, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_appendable", is_appendable, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_blank", is_blank, &error);
libhal_device_set_property_bool (ctx, udi, "volume.disc.is_rewritable", is_rewritable, &error);
libhal_device_set_property_string (ctx, udi, "volume.disc.type", disc_type, &error);
libhal_device_set_property_uint64 (ctx, udi, "volume.disc.capacity", capacity, &error);
my_dbus_error_free (&error);
}
static void
update_disc_volume_properties(int fd, LibHalContext *ctx, const char *udi, int state)
{
DBusError error;
char **volumes;
char *vol_udi;
int num_volumes, i;
dbus_error_init (&error);
/* update volume children */
if ((volumes = libhal_manager_find_device_string_match (
ctx, "info.parent", udi, &num_volumes, &error)) != NULL) {
dbus_error_free (&error);
for (i = 0; i < num_volumes; i++) {
vol_udi = volumes[i];
if (libhal_device_get_property_bool (ctx, vol_udi, "block.is_volume", &error)) {
dbus_error_free (&error);
HAL_DEBUG(("Updating child %s of %s\n", udi, vol_udi));
set_volume_properties(fd, ctx, vol_udi, state);
#if 0
if (libhal_device_get_property_bool (ctx, vol_udi, "volume.is_mounted", &error)) {
dbus_error_free (&error);
HAL_DEBUG (("Forcing unmount of child '%s'", vol_udi));
force_unmount (ctx, vol_udi);
}
#endif
}
}
libhal_free_string_array (volumes);
}
my_dbus_error_free (&error);
}
int
main (int argc, char *argv[])
{
char *udi;
char *device_file, *raw_device_file;
LibHalContext *ctx = NULL;
DBusError error;
char *bus;
char *drive_type;
int state, last_state;
char *support_media_changed_str;
int support_media_changed;
int fd = -1;
if ((udi = getenv ("UDI")) == NULL)
goto out;
if ((device_file = getenv ("HAL_PROP_BLOCK_DEVICE")) == NULL)
goto out;
if ((raw_device_file = getenv ("HAL_PROP_BLOCK_NETBSD_RAW_DEVICE")) == NULL)
goto out;
if ((bus = getenv ("HAL_PROP_STORAGE_BUS")) == NULL)
goto out;
if ((drive_type = getenv ("HAL_PROP_STORAGE_DRIVE_TYPE")) == NULL)
goto out;
setup_logger ();
support_media_changed_str = getenv ("HAL_PROP_STORAGE_CDROM_SUPPORT_MEDIA_CHANGED");
if (support_media_changed_str != NULL && strcmp (support_media_changed_str, "true") == 0)
support_media_changed = TRUE;
else
support_media_changed = FALSE;
dbus_error_init (&error);
if ((ctx = libhal_ctx_init_direct (&error)) == NULL) {
goto out;
}
my_dbus_error_free (&error);
if (!libhal_device_addon_is_ready (ctx, udi, &error)) {
goto out;
}
my_dbus_error_free (&error);
printf ("Doing addon-storage for %s (bus %s) (drive_type %s) (udi %s)\n", device_file, bus, drive_type, udi);
last_state = state = DISC_NONE;
/* Linux version of this addon attempts to re-open the device O_EXCL
* every 2 seconds, trying to figure out if some other app,
* like a cd burner, is using the device. Aside from questionable
* value of this (apps should use HAL's locked property or/and
* Solaris in_use facility), but also frequent opens/closes
* keeps media constantly spun up. All this needs more thought.
*/
for (;;) {
sleep (SLEEP_PERIOD);
if (is_mounted (device_file)) {
close_device (&fd);
} else if ((fd < 0) && ((fd = open (raw_device_file, O_RDONLY | O_NONBLOCK)) < 0)) {
HAL_DEBUG (("open failed for %s: %s", raw_device_file, strerror (errno)));
} else {
/* Check if a disc is in the drive */
state = scsi_test_unit_ready (fd);
if (state == last_state) {
HAL_DEBUG (("state has not changed %d %s", state, device_file));
/* TODO check if eject button was pressed */
/* see linux addons/addon-storage.c */
continue;
} else {
HAL_DEBUG (("new state %d %s", state, device_file));
}
switch (state) {
case DISC_EJECTED:
HAL_DEBUG (("Media removal detected on %s", device_file));
last_state = state;
libhal_device_set_property_bool (ctx, udi, "storage.removable.media_available", FALSE, &error);
my_dbus_error_free (&error);
/* attempt to unmount all childs */
unmount_childs (ctx, udi);
update_disc_volume_properties(fd, ctx, udi, state);
/* could have a fs on the main block device; do a rescan to remove it */
libhal_device_rescan (ctx, udi, &error);
my_dbus_error_free (&error);
break;
case DISC_INSERTED:
HAL_DEBUG (("Media insertion detected on %s", device_file));
last_state = state;
libhal_device_set_property_bool (ctx, udi, "storage.removable.media_available", TRUE, &error);
my_dbus_error_free (&error);
update_disc_volume_properties(fd, ctx, udi, state);
/* could have a fs on the main block device; do a rescan to add it */
libhal_device_rescan (ctx, udi, &error);
my_dbus_error_free (&error);
break;
case DISC_UNKNOWN:
default:
HAL_DEBUG (("Device gone detected on %s", device_file));
last_state = state;
unmount_childs (ctx, udi);
close_device (&fd);
goto out;
}
}
}
out:
if (ctx != NULL) {
my_dbus_error_free (&error);
libhal_ctx_shutdown (ctx, &error);
libhal_ctx_free (ctx);
}
return 0;
}