135 lines
3.4 KiB
C
135 lines
3.4 KiB
C
|
/*********************************************************************
|
||
|
*
|
||
|
* sir_dongle.c: manager for serial dongle protocol drivers
|
||
|
*
|
||
|
* Copyright (c) 2002 Martin Diehl
|
||
|
*
|
||
|
* 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.
|
||
|
*
|
||
|
********************************************************************/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/kmod.h>
|
||
|
#include <linux/mutex.h>
|
||
|
|
||
|
#include <net/irda/irda.h>
|
||
|
|
||
|
#include "sir-dev.h"
|
||
|
|
||
|
/**************************************************************************
|
||
|
*
|
||
|
* dongle registration and attachment
|
||
|
*
|
||
|
*/
|
||
|
|
||
|
static LIST_HEAD(dongle_list); /* list of registered dongle drivers */
|
||
|
static DEFINE_MUTEX(dongle_list_lock); /* protects the list */
|
||
|
|
||
|
int irda_register_dongle(struct dongle_driver *new)
|
||
|
{
|
||
|
struct list_head *entry;
|
||
|
struct dongle_driver *drv;
|
||
|
|
||
|
IRDA_DEBUG(0, "%s : registering dongle \"%s\" (%d).\n",
|
||
|
__func__, new->driver_name, new->type);
|
||
|
|
||
|
mutex_lock(&dongle_list_lock);
|
||
|
list_for_each(entry, &dongle_list) {
|
||
|
drv = list_entry(entry, struct dongle_driver, dongle_list);
|
||
|
if (new->type == drv->type) {
|
||
|
mutex_unlock(&dongle_list_lock);
|
||
|
return -EEXIST;
|
||
|
}
|
||
|
}
|
||
|
list_add(&new->dongle_list, &dongle_list);
|
||
|
mutex_unlock(&dongle_list_lock);
|
||
|
return 0;
|
||
|
}
|
||
|
EXPORT_SYMBOL(irda_register_dongle);
|
||
|
|
||
|
int irda_unregister_dongle(struct dongle_driver *drv)
|
||
|
{
|
||
|
mutex_lock(&dongle_list_lock);
|
||
|
list_del(&drv->dongle_list);
|
||
|
mutex_unlock(&dongle_list_lock);
|
||
|
return 0;
|
||
|
}
|
||
|
EXPORT_SYMBOL(irda_unregister_dongle);
|
||
|
|
||
|
int sirdev_get_dongle(struct sir_dev *dev, IRDA_DONGLE type)
|
||
|
{
|
||
|
struct list_head *entry;
|
||
|
const struct dongle_driver *drv = NULL;
|
||
|
int err = -EINVAL;
|
||
|
|
||
|
request_module("irda-dongle-%d", type);
|
||
|
|
||
|
if (dev->dongle_drv != NULL)
|
||
|
return -EBUSY;
|
||
|
|
||
|
/* serialize access to the list of registered dongles */
|
||
|
mutex_lock(&dongle_list_lock);
|
||
|
|
||
|
list_for_each(entry, &dongle_list) {
|
||
|
drv = list_entry(entry, struct dongle_driver, dongle_list);
|
||
|
if (drv->type == type)
|
||
|
break;
|
||
|
else
|
||
|
drv = NULL;
|
||
|
}
|
||
|
|
||
|
if (!drv) {
|
||
|
err = -ENODEV;
|
||
|
goto out_unlock; /* no such dongle */
|
||
|
}
|
||
|
|
||
|
/* handling of SMP races with dongle module removal - three cases:
|
||
|
* 1) dongle driver was already unregistered - then we haven't found the
|
||
|
* requested dongle above and are already out here
|
||
|
* 2) the module is already marked deleted but the driver is still
|
||
|
* registered - then the try_module_get() below will fail
|
||
|
* 3) the try_module_get() below succeeds before the module is marked
|
||
|
* deleted - then sys_delete_module() fails and prevents the removal
|
||
|
* because the module is in use.
|
||
|
*/
|
||
|
|
||
|
if (!try_module_get(drv->owner)) {
|
||
|
err = -ESTALE;
|
||
|
goto out_unlock; /* rmmod already pending */
|
||
|
}
|
||
|
dev->dongle_drv = drv;
|
||
|
|
||
|
if (!drv->open || (err=drv->open(dev))!=0)
|
||
|
goto out_reject; /* failed to open driver */
|
||
|
|
||
|
mutex_unlock(&dongle_list_lock);
|
||
|
return 0;
|
||
|
|
||
|
out_reject:
|
||
|
dev->dongle_drv = NULL;
|
||
|
module_put(drv->owner);
|
||
|
out_unlock:
|
||
|
mutex_unlock(&dongle_list_lock);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
int sirdev_put_dongle(struct sir_dev *dev)
|
||
|
{
|
||
|
const struct dongle_driver *drv = dev->dongle_drv;
|
||
|
|
||
|
if (drv) {
|
||
|
if (drv->close)
|
||
|
drv->close(dev); /* close this dongle instance */
|
||
|
|
||
|
dev->dongle_drv = NULL; /* unlink the dongle driver */
|
||
|
module_put(drv->owner);/* decrement driver's module refcount */
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|