Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history 
yaml
---
r: 3805
b: refs/heads/master
c: dc10949
h: refs/heads/master
i:
  3803: a506f5b
v: v3
  • Loading branch information
Dominik Brodowski authored and Linus Torvalds committed Jun 28, 2005
1 parent e8482c2 commit da028f0
Show file tree
Hide file tree
Showing 5 changed files with 119 additions and 179 deletions.
2 changes: 1 addition & 1 deletion [refs]
View file
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: b5e43913cfe95a18ad8929585a0bb58e46cf3390
refs/heads/master: dc109497bd5799770fedfc6503119808497b3677
123 changes: 41 additions & 82 deletions trunk/drivers/pcmcia/ds.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -75,7 +75,7 @@ module_param_named(pc_debug, ds_pc_debug, int, 0644);

spinlock_t pcmcia_dev_list_lock;

static int unbind_request(struct pcmcia_bus_socket *s);
static int unbind_request(struct pcmcia_socket *s);

/*====================================================================*/

Expand Down Expand Up @@ -313,24 +313,6 @@ static inline int pcmcia_load_firmware(struct pcmcia_device *dev, char * filenam
/*======================================================================*/


void pcmcia_release_bus_socket(struct kref *refcount)
{
struct pcmcia_bus_socket *s = container_of(refcount, struct pcmcia_bus_socket, refcount);
pcmcia_put_socket(s->parent);
kfree(s);
}

void pcmcia_put_bus_socket(struct pcmcia_bus_socket *s)
{
kref_put(&s->refcount, pcmcia_release_bus_socket);
}

struct pcmcia_bus_socket *pcmcia_get_bus_socket(struct pcmcia_bus_socket *s)
{
kref_get(&s->refcount);
return (s);
}

/**
* pcmcia_register_driver - register a PCMCIA driver with the bus core
*
Expand Down Expand Up @@ -387,7 +369,7 @@ static void pcmcia_release_dev(struct device *dev)
{
struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
ds_dbg(1, "releasing dev %p\n", p_dev);
pcmcia_put_bus_socket(p_dev->socket->pcmcia);
pcmcia_put_socket(p_dev->socket);
kfree(p_dev);
}

Expand Down Expand Up @@ -522,12 +504,12 @@ static int pcmcia_device_query(struct pcmcia_device *p_dev)
*/
static DECLARE_MUTEX(device_add_lock);

struct pcmcia_device * pcmcia_device_add(struct pcmcia_bus_socket *s, unsigned int function)
struct pcmcia_device * pcmcia_device_add(struct pcmcia_socket *s, unsigned int function)
{
struct pcmcia_device *p_dev;
unsigned long flags;

s = pcmcia_get_bus_socket(s);
s = pcmcia_get_socket(s);
if (!s)
return NULL;

Expand All @@ -542,18 +524,18 @@ struct pcmcia_device * pcmcia_device_add(struct pcmcia_bus_socket *s, unsigned i
goto err_put;
memset(p_dev, 0, sizeof(struct pcmcia_device));

p_dev->socket = s->parent;
p_dev->socket = s;
p_dev->device_no = (s->device_count++);
p_dev->func = function;

p_dev->dev.bus = &pcmcia_bus_type;
p_dev->dev.parent = s->parent->dev.dev;
p_dev->dev.parent = s->dev.dev;
p_dev->dev.release = pcmcia_release_dev;
sprintf (p_dev->dev.bus_id, "%d.%d", p_dev->socket->sock, p_dev->device_no);

/* compat */
p_dev->client.client_magic = CLIENT_MAGIC;
p_dev->client.Socket = s->parent;
p_dev->client.Socket = s;
p_dev->client.Function = function;
p_dev->client.state = CLIENT_UNBOUND;

Expand Down Expand Up @@ -581,7 +563,7 @@ struct pcmcia_device * pcmcia_device_add(struct pcmcia_bus_socket *s, unsigned i
s->device_count--;
err_put:
up(&device_add_lock);
pcmcia_put_bus_socket(s);
pcmcia_put_socket(s);

return NULL;
}
Expand Down Expand Up @@ -612,20 +594,20 @@ static int pcmcia_card_add(struct pcmcia_socket *s)
/* this doesn't handle multifunction devices on one pcmcia function
* yet. */
for (i=0; i < no_funcs; i++)
pcmcia_device_add(s->pcmcia, i);
pcmcia_device_add(s, i);

return (ret);
}


static void pcmcia_delayed_add_pseudo_device(void *data)
{
struct pcmcia_bus_socket *s = data;
struct pcmcia_socket *s = data;
pcmcia_device_add(s, 0);
s->pcmcia_state.device_add_pending = 0;
}

static inline void pcmcia_add_pseudo_device(struct pcmcia_bus_socket *s)
static inline void pcmcia_add_pseudo_device(struct pcmcia_socket *s)
{
if (!s->pcmcia_state.device_add_pending) {
schedule_work(&s->device_add);
Expand All @@ -650,7 +632,7 @@ static void pcmcia_bus_rescan(struct pcmcia_socket *skt)

/* must be called with skt_sem held */
spin_lock_irqsave(&pcmcia_dev_list_lock, flags);
if (list_empty(&skt->pcmcia->devices_list))
if (list_empty(&skt->devices_list))
no_devices=1;
spin_unlock_irqrestore(&pcmcia_dev_list_lock, flags);

Expand Down Expand Up @@ -727,7 +709,7 @@ static inline int pcmcia_devmatch(struct pcmcia_device *dev,
* pseudo devices, and if not, add the second one.
*/
if (dev->device_no == 0)
pcmcia_add_pseudo_device(dev->socket->pcmcia);
pcmcia_add_pseudo_device(dev->socket);

if (dev->device_no != did->device_no)
return 0;
Expand Down Expand Up @@ -947,21 +929,13 @@ static int send_event_callback(struct device *dev, void * _data)

static int send_event(struct pcmcia_socket *s, event_t event, int priority)
{
int ret = 0;
struct send_event_data private;
struct pcmcia_bus_socket *skt = pcmcia_get_bus_socket(s->pcmcia);

if (!skt)
return 0;

private.skt = s;
private.event = event;
private.priority = priority;

ret = bus_for_each_dev(&pcmcia_bus_type, NULL, &private, send_event_callback);

pcmcia_put_bus_socket(skt);
return ret;
return bus_for_each_dev(&pcmcia_bus_type, NULL, &private, send_event_callback);
} /* send_event */


Expand All @@ -972,37 +946,39 @@ static int send_event(struct pcmcia_socket *s, event_t event, int priority)

static int ds_event(struct pcmcia_socket *skt, event_t event, int priority)
{
struct pcmcia_bus_socket *s = skt->pcmcia;
struct pcmcia_socket *s = pcmcia_get_socket(skt);
int ret = 0;

ds_dbg(1, "ds_event(0x%06x, %d, 0x%p)\n",
event, priority, s);
event, priority, skt);

switch (event) {

case CS_EVENT_CARD_REMOVAL:
s->pcmcia_state.present = 0;
send_event(skt, event, priority);
unbind_request(s);
handle_event(s, event);
unbind_request(skt);
handle_event(skt, event);
break;

case CS_EVENT_CARD_INSERTION:
s->pcmcia_state.present = 1;
pcmcia_card_add(skt);
handle_event(s, event);
handle_event(skt, event);
break;

case CS_EVENT_EJECTION_REQUEST:
ret = send_event(skt, event, priority);
break;

default:
handle_event(s, event);
handle_event(skt, event);
send_event(skt, event, priority);
break;
}

pcmcia_put_socket(s);

return 0;
} /* ds_event */

Expand All @@ -1011,8 +987,7 @@ static int ds_event(struct pcmcia_socket *skt, event_t event, int priority)
int pcmcia_register_client(client_handle_t *handle, client_reg_t *req)
{
client_t *client = NULL;
struct pcmcia_socket *s;
struct pcmcia_bus_socket *skt = NULL;
struct pcmcia_socket *s = NULL;
struct pcmcia_device *p_dev = NULL;

/* Look for unbound client with matching dev_info */
Expand All @@ -1023,14 +998,11 @@ int pcmcia_register_client(client_handle_t *handle, client_reg_t *req)
if (s->state & SOCKET_CARDBUS)
continue;

skt = s->pcmcia;
if (!skt)
continue;
skt = pcmcia_get_bus_socket(skt);
if (!skt)
s = pcmcia_get_socket(s);
if (!s)
continue;
spin_lock_irqsave(&pcmcia_dev_list_lock, flags);
list_for_each_entry(p_dev, &skt->devices_list, socket_device_list) {
list_for_each_entry(p_dev, &s->devices_list, socket_device_list) {
struct pcmcia_driver *p_drv;
p_dev = pcmcia_get_dev(p_dev);
if (!p_dev)
Expand All @@ -1049,14 +1021,14 @@ int pcmcia_register_client(client_handle_t *handle, client_reg_t *req)
pcmcia_put_dev(p_dev);
}
spin_unlock_irqrestore(&pcmcia_dev_list_lock, flags);
pcmcia_put_bus_socket(skt);
pcmcia_put_socket(s);
}
found:
up_read(&pcmcia_socket_list_rwsem);
if (!p_dev || !client)
return -ENODEV;

pcmcia_put_bus_socket(skt); /* safe, as we already hold a reference from bind_device */
pcmcia_put_socket(s); /* safe, as we already hold a reference from bind_device */

*handle = client;
client->state &= ~CLIENT_UNBOUND;
Expand Down Expand Up @@ -1106,12 +1078,12 @@ EXPORT_SYMBOL(pcmcia_register_client);
/* unbind _all_ devices attached to a given pcmcia_bus_socket. The
* drivers have been called with EVENT_CARD_REMOVAL before.
*/
static int unbind_request(struct pcmcia_bus_socket *s)
static int unbind_request(struct pcmcia_socket *s)
{
struct pcmcia_device *p_dev;
unsigned long flags;

ds_dbg(2, "unbind_request(%d)\n", s->parent->sock);
ds_dbg(2, "unbind_request(%d)\n", s->sock);

s->device_count = 0;

Expand Down Expand Up @@ -1176,44 +1148,32 @@ static struct pcmcia_callback pcmcia_bus_callback = {
static int __devinit pcmcia_bus_add_socket(struct class_device *class_dev)
{
struct pcmcia_socket *socket = class_get_devdata(class_dev);
struct pcmcia_bus_socket *s;
int ret;

s = kmalloc(sizeof(struct pcmcia_bus_socket), GFP_KERNEL);
if(!s)
return -ENOMEM;
memset(s, 0, sizeof(struct pcmcia_bus_socket));

/* get reference to parent socket */
s->parent = pcmcia_get_socket(socket);
if (!s->parent) {
socket = pcmcia_get_socket(socket);
if (!socket) {
printk(KERN_ERR "PCMCIA obtaining reference to socket %p failed\n", socket);
kfree (s);
return -ENODEV;
}

kref_init(&s->refcount);

/*
* Ugly. But we want to wait for the socket threads to have started up.
* We really should let the drivers themselves drive some of this..
*/
msleep(250);

#ifdef CONFIG_PCMCIA_IOCTL
init_waitqueue_head(&s->queue);
init_waitqueue_head(&socket->queue);
#endif
INIT_LIST_HEAD(&s->devices_list);
INIT_WORK(&s->device_add, pcmcia_delayed_add_pseudo_device, s);

/* Set up hotline to Card Services */
socket->pcmcia = s;
INIT_LIST_HEAD(&socket->devices_list);
INIT_WORK(&socket->device_add, pcmcia_delayed_add_pseudo_device, socket);
memset(&socket->pcmcia_state, 0, sizeof(u8));
socket->device_count = 0;

ret = pccard_register_pcmcia(socket, &pcmcia_bus_callback);
if (ret) {
printk(KERN_ERR "PCMCIA registration PCCard core failed for socket %p\n", socket);
pcmcia_put_bus_socket(s);
socket->pcmcia = NULL;
pcmcia_put_socket(socket);
return (ret);
}

Expand All @@ -1224,14 +1184,13 @@ static void pcmcia_bus_remove_socket(struct class_device *class_dev)
{
struct pcmcia_socket *socket = class_get_devdata(class_dev);

if (!socket || !socket->pcmcia)
if (!socket)
return;

socket->pcmcia_state.dead = 1;
pccard_register_pcmcia(socket, NULL);

socket->pcmcia->pcmcia_state.dead = 1;
pcmcia_put_bus_socket(socket->pcmcia);
socket->pcmcia = NULL;
pcmcia_put_socket(socket);

return;
}
Expand Down
45 changes: 5 additions & 40 deletions trunk/drivers/pcmcia/ds_internal.h
View file
Original file line number Diff line number Diff line change
@@ -1,56 +1,21 @@
/* ds_internal.h - internal header for 16-bit PCMCIA devices management */

struct user_info_t;

/* Socket state information */
struct pcmcia_bus_socket {
struct kref refcount;
struct pcmcia_socket *parent;

/* the PCMCIA devices connected to this socket (normally one, more
* for multifunction devices: */
struct list_head devices_list;
u8 device_count; /* the number of devices, used
* only internally and subject
* to incorrectness and change */

struct {
u8 present:1,
busy:1,
dead:1,
device_add_pending:1,
reserved:4;
} pcmcia_state;

struct work_struct device_add;


#ifdef CONFIG_PCMCIA_IOCTL
struct user_info_t *user;
wait_queue_head_t queue;
#endif
};
extern spinlock_t pcmcia_dev_list_lock;

extern struct bus_type pcmcia_bus_type;


extern struct pcmcia_device * pcmcia_get_dev(struct pcmcia_device *p_dev);
extern void pcmcia_put_dev(struct pcmcia_device *p_dev);

struct pcmcia_bus_socket *pcmcia_get_bus_socket(struct pcmcia_bus_socket *s);
void pcmcia_put_bus_socket(struct pcmcia_bus_socket *s);

struct pcmcia_device * pcmcia_device_add(struct pcmcia_bus_socket *s, unsigned int function);
struct pcmcia_device * pcmcia_device_add(struct pcmcia_socket *s, unsigned int function);

#ifdef CONFIG_PCMCIA_IOCTL
extern void __init pcmcia_setup_ioctl(void);
extern void __exit pcmcia_cleanup_ioctl(void);
extern void handle_event(struct pcmcia_bus_socket *s, event_t event);
extern int handle_request(struct pcmcia_bus_socket *s, event_t event);
extern void handle_event(struct pcmcia_socket *s, event_t event);
extern int handle_request(struct pcmcia_socket *s, event_t event);
#else
static inline void __init pcmcia_setup_ioctl(void) { return; }
static inline void __init pcmcia_cleanup_ioctl(void) { return; }
static inline void handle_event(struct pcmcia_bus_socket *s, event_t event) { return; }
static inline int handle_request(struct pcmcia_bus_socket *s, event_t event) { return CS_SUCCESS; }
static inline void handle_event(struct pcmcia_socket *s, event_t event) { return; }
static inline int handle_request(struct pcmcia_socket *s, event_t event) { return CS_SUCCESS; }
#endif
Loading

0 comments on commit da028f0

Please sign in to comment.