summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--drivers/net/usb/hso.c110
1 files changed, 87 insertions, 23 deletions
diff --git a/drivers/net/usb/hso.c b/drivers/net/usb/hso.c
index 2c172435495f..cc37a2e67177 100644
--- a/drivers/net/usb/hso.c
+++ b/drivers/net/usb/hso.c
@@ -230,6 +230,11 @@ struct hso_serial {
struct work_struct retry_unthrottle_workqueue;
};
+struct hso_mutex_t {
+ struct mutex mutex;
+ u8 allocated;
+};
+
struct hso_device {
union {
struct hso_serial *dev_serial;
@@ -248,7 +253,7 @@ struct hso_device {
struct device *dev;
struct kref ref;
- struct mutex mutex;
+ struct hso_mutex_t *mutex;
};
/* Type of interface */
@@ -364,6 +369,13 @@ static struct hso_device *network_table[HSO_MAX_NET_DEVICES];
static spinlock_t serial_table_lock;
static struct ktermios *hso_serial_termios[HSO_SERIAL_TTY_MINORS];
static struct ktermios *hso_serial_termios_locked[HSO_SERIAL_TTY_MINORS];
+/* hso_mutex_table has to be declared statically as hso_device
+ * is freed in hso_serial_open & hso_serial_close while
+ * the mutex is still in use.
+ */
+#define HSO_NUM_MUTEXES (HSO_SERIAL_TTY_MINORS+HSO_MAX_NET_DEVICES)
+static struct hso_mutex_t hso_mutex_table[HSO_NUM_MUTEXES];
+static spinlock_t hso_mutex_lock;
static const s32 default_port_spec[] = {
HSO_INTF_MUX | HSO_PORT_NETWORK,
@@ -604,6 +616,34 @@ static void set_serial_by_index(unsigned index, struct hso_serial *serial)
spin_unlock_irqrestore(&serial_table_lock, flags);
}
+
+static struct hso_mutex_t *hso_get_free_mutex(void)
+{
+ int index;
+ struct hso_mutex_t *curr_hso_mutex;
+
+ spin_lock(&hso_mutex_lock);
+ for (index = 0; index < HSO_NUM_MUTEXES; index++) {
+ curr_hso_mutex = &hso_mutex_table[index];
+ if (!curr_hso_mutex->allocated) {
+ curr_hso_mutex->allocated = 1;
+ spin_unlock(&hso_mutex_lock);
+ return curr_hso_mutex;
+ }
+ }
+ printk(KERN_ERR "BUG %s: no free hso_mutexs devices in table\n"
+ , __func__);
+ spin_unlock(&hso_mutex_lock);
+ return NULL;
+}
+
+static void hso_free_mutex(struct hso_mutex_t *mutex)
+{
+ spin_lock(&hso_mutex_lock);
+ mutex->allocated = 0;
+ spin_unlock(&hso_mutex_lock);
+}
+
/* log a meaningful explanation of an USB status */
static void log_usb_status(int status, const char *function)
{
@@ -1225,7 +1265,9 @@ void hso_unthrottle_workfunc(struct work_struct *work)
static int hso_serial_open(struct tty_struct *tty, struct file *filp)
{
struct hso_serial *serial = get_serial_by_index(tty->index);
- int result;
+ int result1 = 0, result2 = 0;
+ struct mutex *hso_mutex = NULL;
+ int refcnt = 1;
/* sanity check */
if (serial == NULL || serial->magic != HSO_SERIAL_MAGIC) {
@@ -1234,14 +1276,15 @@ static int hso_serial_open(struct tty_struct *tty, struct file *filp)
return -ENODEV;
}
- mutex_lock(&serial->parent->mutex);
+ hso_mutex = &serial->parent->mutex->mutex;
+ mutex_lock(hso_mutex);
/* check for port already opened, if not set the termios */
/* The serial->open count needs to be here as hso_serial_close
* will be called even if hso_serial_open returns -ENODEV.
*/
serial->open_count++;
- result = usb_autopm_get_interface(serial->parent->interface);
- if (result < 0)
+ result1 = usb_autopm_get_interface(serial->parent->interface);
+ if (result1 < 0)
goto err_out;
D1("Opening %d", serial->minor);
@@ -1261,11 +1304,10 @@ static int hso_serial_open(struct tty_struct *tty, struct file *filp)
(unsigned long)serial);
INIT_WORK(&serial->retry_unthrottle_workqueue,
hso_unthrottle_workfunc);
- result = hso_start_serial_device(serial->parent, GFP_KERNEL);
- if (result) {
+ result2 = hso_start_serial_device(serial->parent, GFP_KERNEL);
+ if (result2) {
hso_stop_serial_device(serial->parent);
serial->open_count--;
- kref_put(&serial->parent->ref, hso_serial_ref_free);
}
} else {
D1("Port was already open");
@@ -1274,11 +1316,16 @@ static int hso_serial_open(struct tty_struct *tty, struct file *filp)
usb_autopm_put_interface(serial->parent->interface);
/* done */
- if (result)
+ if (result1)
hso_serial_tiocmset(tty, NULL, TIOCM_RTS | TIOCM_DTR, 0);
err_out:
- mutex_unlock(&serial->parent->mutex);
- return result;
+ if (result2)
+ refcnt = kref_put(&serial->parent->ref, hso_serial_ref_free);
+ mutex_unlock(hso_mutex);
+ if (refcnt == 0)
+ hso_free_mutex(container_of(hso_mutex,
+ struct hso_mutex_t, mutex));
+ return result1 == 0 ? result2 : result1;
}
/* close the requested serial port */
@@ -1286,6 +1333,8 @@ static void hso_serial_close(struct tty_struct *tty, struct file *filp)
{
struct hso_serial *serial = tty->driver_data;
u8 usb_gone;
+ struct mutex *hso_mutex;
+ int refcnt;
D1("Closing serial port");
if (serial == NULL || serial->magic != HSO_SERIAL_MAGIC) {
@@ -1293,8 +1342,9 @@ static void hso_serial_close(struct tty_struct *tty, struct file *filp)
return;
}
- mutex_lock(&serial->parent->mutex);
usb_gone = serial->parent->usb_gone;
+ hso_mutex = &serial->parent->mutex->mutex;
+ mutex_lock(hso_mutex);
if (!usb_gone)
usb_autopm_get_interface(serial->parent->interface);
@@ -1302,7 +1352,6 @@ static void hso_serial_close(struct tty_struct *tty, struct file *filp)
/* reset the rts and dtr */
/* do the actual close */
serial->open_count--;
- kref_put(&serial->parent->ref, hso_serial_ref_free);
if (serial->open_count <= 0) {
serial->open_count = 0;
if (serial->tty) {
@@ -1317,8 +1366,11 @@ static void hso_serial_close(struct tty_struct *tty, struct file *filp)
if (!usb_gone)
usb_autopm_put_interface(serial->parent->interface);
-
- mutex_unlock(&serial->parent->mutex);
+ refcnt = kref_put(&serial->parent->ref, hso_serial_ref_free);
+ mutex_unlock(hso_mutex);
+ if (refcnt == 0)
+ hso_free_mutex(container_of(hso_mutex,
+ struct hso_mutex_t, mutex));
}
/* close the requested serial port */
@@ -2084,8 +2136,12 @@ static struct hso_device *hso_create_device(struct usb_interface *intf,
hso_dev->usb = interface_to_usbdev(intf);
hso_dev->interface = intf;
kref_init(&hso_dev->ref);
- mutex_init(&hso_dev->mutex);
-
+ hso_dev->mutex = hso_get_free_mutex();
+ if (!hso_dev->mutex) {
+ kfree(hso_dev);
+ return NULL;
+ }
+ mutex_init(&hso_dev->mutex->mutex);
INIT_WORK(&hso_dev->async_get_intf, async_get_intf);
INIT_WORK(&hso_dev->async_put_intf, async_put_intf);
@@ -2131,7 +2187,7 @@ static void hso_free_net_device(struct hso_device *hso_dev)
unregister_netdev(hso_net->net);
free_netdev(hso_net->net);
}
-
+ hso_free_mutex(hso_dev->mutex);
hso_free_device(hso_dev);
}
@@ -2180,14 +2236,14 @@ static int hso_radio_toggle(void *data, enum rfkill_state state)
int enabled = (state == RFKILL_STATE_ON);
int rv;
- mutex_lock(&hso_dev->mutex);
+ mutex_lock(&hso_dev->mutex->mutex);
if (hso_dev->usb_gone)
rv = 0;
else
rv = usb_control_msg(hso_dev->usb, usb_rcvctrlpipe(hso_dev->usb, 0),
enabled ? 0x82 : 0x81, 0x40, 0, 0, NULL, 0,
USB_CTRL_SET_TIMEOUT);
- mutex_unlock(&hso_dev->mutex);
+ mutex_unlock(&hso_dev->mutex->mutex);
return rv;
}
@@ -2795,6 +2851,8 @@ static void hso_free_interface(struct usb_interface *interface)
{
struct hso_serial *hso_dev;
int i;
+ struct mutex *hso_mutex = NULL;
+ int refcnt = 1;
for (i = 0; i < HSO_SERIAL_TTY_MINORS; i++) {
if (serial_table[i]
@@ -2802,10 +2860,12 @@ static void hso_free_interface(struct usb_interface *interface)
hso_dev = dev2ser(serial_table[i]);
if (hso_dev->tty)
tty_hangup(hso_dev->tty);
- mutex_lock(&hso_dev->parent->mutex);
+ hso_mutex = &hso_dev->parent->mutex->mutex;
+ mutex_lock(hso_mutex);
hso_dev->parent->usb_gone = 1;
- mutex_unlock(&hso_dev->parent->mutex);
- kref_put(&serial_table[i]->ref, hso_serial_ref_free);
+ refcnt = kref_put(&serial_table[i]->ref,
+ hso_serial_ref_free);
+ mutex_unlock(hso_mutex);
}
}
@@ -2824,6 +2884,9 @@ static void hso_free_interface(struct usb_interface *interface)
hso_free_net_device(network_table[i]);
}
}
+ if (refcnt == 0)
+ hso_free_mutex(container_of(hso_mutex,
+ struct hso_mutex_t, mutex));
}
/* Helper functions */
@@ -2922,6 +2985,7 @@ static int __init hso_init(void)
/* Initialise the serial table semaphore and table */
spin_lock_init(&serial_table_lock);
+ spin_lock_init(&hso_mutex_lock);
for (i = 0; i < HSO_SERIAL_TTY_MINORS; i++)
serial_table[i] = NULL;