mirror of
https://github.com/ukui/kernel.git
synced 2026-03-09 10:07:04 -07:00
Merge git://git.kernel.org/pub/scm/linux/kernel/git/brodo/pcmcia-2.6
This commit is contained in:
@@ -1,5 +1,16 @@
|
||||
This file details changes in 2.6 which affect PCMCIA card driver authors:
|
||||
|
||||
* Unify detach and REMOVAL event code, as well as attach and INSERTION
|
||||
code (as of 2.6.16)
|
||||
void (*remove) (struct pcmcia_device *dev);
|
||||
int (*probe) (struct pcmcia_device *dev);
|
||||
|
||||
* Move suspend, resume and reset out of event handler (as of 2.6.16)
|
||||
int (*suspend) (struct pcmcia_device *dev);
|
||||
int (*resume) (struct pcmcia_device *dev);
|
||||
should be initialized in struct pcmcia_driver, and handle
|
||||
(SUSPEND == RESET_PHYSICAL) and (RESUME == CARD_RESET) events
|
||||
|
||||
* event handler initialization in struct pcmcia_driver (as of 2.6.13)
|
||||
The event handler is notified of all events, and must be initialized
|
||||
as the event() callback in the driver's struct pcmcia_driver.
|
||||
|
||||
@@ -62,6 +62,7 @@ int dpm_runtime_suspend(struct device * dev, pm_message_t state)
|
||||
up(&dpm_sem);
|
||||
return error;
|
||||
}
|
||||
EXPORT_SYMBOL(dpm_runtime_suspend);
|
||||
|
||||
|
||||
#if 0
|
||||
|
||||
@@ -87,14 +87,8 @@ typedef struct bluecard_info_t {
|
||||
|
||||
static void bluecard_config(dev_link_t *link);
|
||||
static void bluecard_release(dev_link_t *link);
|
||||
static int bluecard_event(event_t event, int priority, event_callback_args_t *args);
|
||||
|
||||
static dev_info_t dev_info = "bluecard_cs";
|
||||
|
||||
static dev_link_t *bluecard_attach(void);
|
||||
static void bluecard_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
static void bluecard_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
|
||||
/* Default baud rate: 57600, 115200, 230400 or 460800 */
|
||||
@@ -862,17 +856,15 @@ static int bluecard_close(bluecard_info_t *info)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static dev_link_t *bluecard_attach(void)
|
||||
static int bluecard_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
bluecard_info_t *info;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
int ret;
|
||||
|
||||
/* Create new info device */
|
||||
info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||
if (!info)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
link = &info->link;
|
||||
link->priv = info;
|
||||
@@ -889,50 +881,24 @@ static dev_link_t *bluecard_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
bluecard_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
bluecard_config(link);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static void bluecard_detach(dev_link_t *link)
|
||||
static void bluecard_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
bluecard_info_t *info = link->priv;
|
||||
dev_link_t **linkp;
|
||||
int ret;
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link)
|
||||
break;
|
||||
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
bluecard_release(link);
|
||||
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
|
||||
kfree(info);
|
||||
}
|
||||
|
||||
@@ -1045,39 +1011,24 @@ static void bluecard_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
|
||||
static int bluecard_event(event_t event, int priority, event_callback_args_t *args)
|
||||
static int bluecard_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
bluecard_info_t *info = link->priv;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
bluecard_close(info);
|
||||
bluecard_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
bluecard_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int bluecard_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -1095,10 +1046,11 @@ static struct pcmcia_driver bluecard_driver = {
|
||||
.drv = {
|
||||
.name = "bluecard_cs",
|
||||
},
|
||||
.attach = bluecard_attach,
|
||||
.event = bluecard_event,
|
||||
.detach = bluecard_detach,
|
||||
.probe = bluecard_attach,
|
||||
.remove = bluecard_detach,
|
||||
.id_table = bluecard_ids,
|
||||
.suspend = bluecard_suspend,
|
||||
.resume = bluecard_resume,
|
||||
};
|
||||
|
||||
static int __init init_bluecard_cs(void)
|
||||
@@ -1110,7 +1062,6 @@ static int __init init_bluecard_cs(void)
|
||||
static void __exit exit_bluecard_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&bluecard_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_bluecard_cs);
|
||||
|
||||
@@ -90,14 +90,8 @@ typedef struct bt3c_info_t {
|
||||
|
||||
static void bt3c_config(dev_link_t *link);
|
||||
static void bt3c_release(dev_link_t *link);
|
||||
static int bt3c_event(event_t event, int priority, event_callback_args_t *args);
|
||||
|
||||
static dev_info_t dev_info = "bt3c_cs";
|
||||
|
||||
static dev_link_t *bt3c_attach(void);
|
||||
static void bt3c_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
static void bt3c_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
|
||||
/* Transmit states */
|
||||
@@ -663,17 +657,15 @@ static int bt3c_close(bt3c_info_t *info)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static dev_link_t *bt3c_attach(void)
|
||||
static int bt3c_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
bt3c_info_t *info;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
int ret;
|
||||
|
||||
/* Create new info device */
|
||||
info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||
if (!info)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
link = &info->link;
|
||||
link->priv = info;
|
||||
@@ -690,50 +682,24 @@ static dev_link_t *bt3c_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
bt3c_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
bt3c_config(link);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static void bt3c_detach(dev_link_t *link)
|
||||
static void bt3c_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
bt3c_info_t *info = link->priv;
|
||||
dev_link_t **linkp;
|
||||
int ret;
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link)
|
||||
break;
|
||||
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
bt3c_release(link);
|
||||
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
|
||||
kfree(info);
|
||||
}
|
||||
|
||||
@@ -891,43 +857,29 @@ static void bt3c_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
|
||||
static int bt3c_event(event_t event, int priority, event_callback_args_t *args)
|
||||
static int bt3c_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
bt3c_info_t *info = link->priv;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
bt3c_close(info);
|
||||
bt3c_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
bt3c_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int bt3c_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id bt3c_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID13("3COM", "Bluetooth PC Card", 0xefce0a31, 0xd4ce9b02),
|
||||
PCMCIA_DEVICE_NULL
|
||||
@@ -939,10 +891,11 @@ static struct pcmcia_driver bt3c_driver = {
|
||||
.drv = {
|
||||
.name = "bt3c_cs",
|
||||
},
|
||||
.attach = bt3c_attach,
|
||||
.event = bt3c_event,
|
||||
.detach = bt3c_detach,
|
||||
.probe = bt3c_attach,
|
||||
.remove = bt3c_detach,
|
||||
.id_table = bt3c_ids,
|
||||
.suspend = bt3c_suspend,
|
||||
.resume = bt3c_resume,
|
||||
};
|
||||
|
||||
static int __init init_bt3c_cs(void)
|
||||
@@ -954,7 +907,6 @@ static int __init init_bt3c_cs(void)
|
||||
static void __exit exit_bt3c_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&bt3c_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_bt3c_cs);
|
||||
|
||||
@@ -86,14 +86,8 @@ typedef struct btuart_info_t {
|
||||
|
||||
static void btuart_config(dev_link_t *link);
|
||||
static void btuart_release(dev_link_t *link);
|
||||
static int btuart_event(event_t event, int priority, event_callback_args_t *args);
|
||||
|
||||
static dev_info_t dev_info = "btuart_cs";
|
||||
|
||||
static dev_link_t *btuart_attach(void);
|
||||
static void btuart_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
static void btuart_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
|
||||
/* Maximum baud rate */
|
||||
@@ -582,17 +576,15 @@ static int btuart_close(btuart_info_t *info)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static dev_link_t *btuart_attach(void)
|
||||
static int btuart_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
btuart_info_t *info;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
int ret;
|
||||
|
||||
/* Create new info device */
|
||||
info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||
if (!info)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
link = &info->link;
|
||||
link->priv = info;
|
||||
@@ -609,50 +601,24 @@ static dev_link_t *btuart_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
btuart_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
btuart_config(link);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static void btuart_detach(dev_link_t *link)
|
||||
static void btuart_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
btuart_info_t *info = link->priv;
|
||||
dev_link_t **linkp;
|
||||
int ret;
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link)
|
||||
break;
|
||||
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
btuart_release(link);
|
||||
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
|
||||
kfree(info);
|
||||
}
|
||||
|
||||
@@ -811,43 +777,29 @@ static void btuart_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
|
||||
static int btuart_event(event_t event, int priority, event_callback_args_t *args)
|
||||
static int btuart_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
btuart_info_t *info = link->priv;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
btuart_close(info);
|
||||
btuart_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
btuart_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int btuart_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id btuart_ids[] = {
|
||||
/* don't use this driver. Use serial_cs + hci_uart instead */
|
||||
PCMCIA_DEVICE_NULL
|
||||
@@ -859,10 +811,11 @@ static struct pcmcia_driver btuart_driver = {
|
||||
.drv = {
|
||||
.name = "btuart_cs",
|
||||
},
|
||||
.attach = btuart_attach,
|
||||
.event = btuart_event,
|
||||
.detach = btuart_detach,
|
||||
.probe = btuart_attach,
|
||||
.remove = btuart_detach,
|
||||
.id_table = btuart_ids,
|
||||
.suspend = btuart_suspend,
|
||||
.resume = btuart_resume,
|
||||
};
|
||||
|
||||
static int __init init_btuart_cs(void)
|
||||
@@ -874,7 +827,6 @@ static int __init init_btuart_cs(void)
|
||||
static void __exit exit_btuart_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&btuart_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_btuart_cs);
|
||||
|
||||
@@ -89,14 +89,8 @@ typedef struct dtl1_info_t {
|
||||
|
||||
static void dtl1_config(dev_link_t *link);
|
||||
static void dtl1_release(dev_link_t *link);
|
||||
static int dtl1_event(event_t event, int priority, event_callback_args_t *args);
|
||||
|
||||
static dev_info_t dev_info = "dtl1_cs";
|
||||
|
||||
static dev_link_t *dtl1_attach(void);
|
||||
static void dtl1_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
static void dtl1_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
|
||||
/* Transmit states */
|
||||
@@ -561,17 +555,15 @@ static int dtl1_close(dtl1_info_t *info)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static dev_link_t *dtl1_attach(void)
|
||||
static int dtl1_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dtl1_info_t *info;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
int ret;
|
||||
|
||||
/* Create new info device */
|
||||
info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||
if (!info)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
link = &info->link;
|
||||
link->priv = info;
|
||||
@@ -588,50 +580,24 @@ static dev_link_t *dtl1_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
dtl1_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
dtl1_config(link);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static void dtl1_detach(dev_link_t *link)
|
||||
static void dtl1_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
dtl1_info_t *info = link->priv;
|
||||
dev_link_t **linkp;
|
||||
int ret;
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link)
|
||||
break;
|
||||
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
dtl1_release(link);
|
||||
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
|
||||
kfree(info);
|
||||
}
|
||||
|
||||
@@ -763,46 +729,33 @@ static void dtl1_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
|
||||
static int dtl1_event(event_t event, int priority, event_callback_args_t *args)
|
||||
static int dtl1_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
dtl1_info_t *info = link->priv;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
dtl1_close(info);
|
||||
dtl1_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
dtl1_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int dtl1_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id dtl1_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("Nokia Mobile Phones", "DTL-1", 0xe1bfdd64, 0xe168480d),
|
||||
PCMCIA_DEVICE_PROD_ID12("Socket", "CF", 0xb38bcc2e, 0x44ebf863),
|
||||
PCMCIA_DEVICE_PROD_ID12("Socket", "CF+ Personal Network Card", 0xb38bcc2e, 0xe732bae3),
|
||||
PCMCIA_DEVICE_NULL
|
||||
};
|
||||
MODULE_DEVICE_TABLE(pcmcia, dtl1_ids);
|
||||
@@ -812,10 +765,11 @@ static struct pcmcia_driver dtl1_driver = {
|
||||
.drv = {
|
||||
.name = "dtl1_cs",
|
||||
},
|
||||
.attach = dtl1_attach,
|
||||
.event = dtl1_event,
|
||||
.detach = dtl1_detach,
|
||||
.probe = dtl1_attach,
|
||||
.remove = dtl1_detach,
|
||||
.id_table = dtl1_ids,
|
||||
.suspend = dtl1_suspend,
|
||||
.resume = dtl1_resume,
|
||||
};
|
||||
|
||||
static int __init init_dtl1_cs(void)
|
||||
@@ -827,7 +781,6 @@ static int __init init_dtl1_cs(void)
|
||||
static void __exit exit_dtl1_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&dtl1_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_dtl1_cs);
|
||||
|
||||
@@ -66,7 +66,6 @@ static char *version = "cm4000_cs.c v2.4.0gm5 - All bugs added by Harald Welte";
|
||||
#define T_100MSEC msecs_to_jiffies(100)
|
||||
#define T_500MSEC msecs_to_jiffies(500)
|
||||
|
||||
static void cm4000_detach(dev_link_t *link);
|
||||
static void cm4000_release(dev_link_t *link);
|
||||
|
||||
static int major; /* major number we get from the kernel */
|
||||
@@ -156,7 +155,6 @@ struct cm4000_dev {
|
||||
/*sbuf*/ 512*sizeof(char) - \
|
||||
/*queue*/ 4*sizeof(wait_queue_head_t))
|
||||
|
||||
static dev_info_t dev_info = MODULE_NAME;
|
||||
static dev_link_t *dev_table[CM4000_MAX_DEV];
|
||||
|
||||
/* This table doesn't use spaces after the comma between fields and thus
|
||||
@@ -1864,68 +1862,36 @@ cs_release:
|
||||
link->state &= ~DEV_CONFIG_PENDING;
|
||||
}
|
||||
|
||||
static int cm4000_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int cm4000_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct cm4000_dev *dev;
|
||||
int devno;
|
||||
|
||||
link = args->client_data;
|
||||
dev = link->priv;
|
||||
|
||||
DEBUGP(3, dev, "-> cm4000_event\n");
|
||||
for (devno = 0; devno < CM4000_MAX_DEV; devno++)
|
||||
if (dev_table[devno] == link)
|
||||
break;
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
stop_monitor(dev);
|
||||
|
||||
if (devno == CM4000_MAX_DEV)
|
||||
return CS_BAD_ADAPTER;
|
||||
return 0;
|
||||
}
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_INSERTION\n");
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
cm4000_config(link, devno);
|
||||
break;
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_REMOVAL\n");
|
||||
link->state &= ~DEV_PRESENT;
|
||||
stop_monitor(dev);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
DEBUGP(5, dev, "CS_EVENT_PM_SUSPEND "
|
||||
"(fall-through to CS_EVENT_RESET_PHYSICAL)\n");
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* fall-through */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
DEBUGP(5, dev, "CS_EVENT_RESET_PHYSICAL\n");
|
||||
if (link->state & DEV_CONFIG) {
|
||||
DEBUGP(5, dev, "ReleaseConfiguration\n");
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
stop_monitor(dev);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
DEBUGP(5, dev, "CS_EVENT_PM_RESUME "
|
||||
"(fall-through to CS_EVENT_CARD_RESET)\n");
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* fall-through */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_RESET\n");
|
||||
if ((link->state & DEV_CONFIG)) {
|
||||
DEBUGP(5, dev, "RequestConfiguration\n");
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
}
|
||||
if (link->open)
|
||||
start_monitor(dev);
|
||||
break;
|
||||
default:
|
||||
DEBUGP(5, dev, "unknown event %.2x\n", event);
|
||||
break;
|
||||
}
|
||||
DEBUGP(3, dev, "<- cm4000_event\n");
|
||||
return CS_SUCCESS;
|
||||
static int cm4000_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct cm4000_dev *dev;
|
||||
|
||||
dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
if (link->open)
|
||||
start_monitor(dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void cm4000_release(dev_link_t *link)
|
||||
@@ -1935,11 +1901,10 @@ static void cm4000_release(dev_link_t *link)
|
||||
pcmcia_release_io(link->handle, &link->io);
|
||||
}
|
||||
|
||||
static dev_link_t *cm4000_attach(void)
|
||||
static int cm4000_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
struct cm4000_dev *dev;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < CM4000_MAX_DEV; i++)
|
||||
@@ -1948,76 +1913,55 @@ static dev_link_t *cm4000_attach(void)
|
||||
|
||||
if (i == CM4000_MAX_DEV) {
|
||||
printk(KERN_NOTICE MODULE_NAME ": all devices in use\n");
|
||||
return NULL;
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* create a new cm4000_cs device */
|
||||
dev = kzalloc(sizeof(struct cm4000_dev), GFP_KERNEL);
|
||||
if (dev == NULL)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
link = &dev->link;
|
||||
link->priv = dev;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
dev_table[i] = link;
|
||||
|
||||
/* register with card services */
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.EventMask =
|
||||
CS_EVENT_CARD_INSERTION | CS_EVENT_CARD_REMOVAL |
|
||||
CS_EVENT_RESET_PHYSICAL | CS_EVENT_CARD_RESET |
|
||||
CS_EVENT_PM_SUSPEND | CS_EVENT_PM_RESUME;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
|
||||
i = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (i) {
|
||||
cs_error(link->handle, RegisterClient, i);
|
||||
cm4000_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
init_waitqueue_head(&dev->devq);
|
||||
init_waitqueue_head(&dev->ioq);
|
||||
init_waitqueue_head(&dev->atrq);
|
||||
init_waitqueue_head(&dev->readq);
|
||||
|
||||
return link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
cm4000_config(link, i);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void cm4000_detach_by_devno(int devno, dev_link_t * link)
|
||||
static void cm4000_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct cm4000_dev *dev = link->priv;
|
||||
|
||||
DEBUGP(3, dev, "-> detach_by_devno(devno=%d)\n", devno);
|
||||
|
||||
if (link->state & DEV_CONFIG) {
|
||||
DEBUGP(5, dev, "device still configured (try to release it)\n");
|
||||
cm4000_release(link);
|
||||
}
|
||||
|
||||
if (link->handle) {
|
||||
pcmcia_deregister_client(link->handle);
|
||||
}
|
||||
|
||||
dev_table[devno] = NULL;
|
||||
kfree(dev);
|
||||
return;
|
||||
}
|
||||
|
||||
static void cm4000_detach(dev_link_t * link)
|
||||
{
|
||||
int i;
|
||||
int devno;
|
||||
|
||||
/* find device */
|
||||
for (i = 0; i < CM4000_MAX_DEV; i++)
|
||||
if (dev_table[i] == link)
|
||||
for (devno = 0; devno < CM4000_MAX_DEV; devno++)
|
||||
if (dev_table[devno] == link)
|
||||
break;
|
||||
|
||||
if (i == CM4000_MAX_DEV)
|
||||
if (devno == CM4000_MAX_DEV)
|
||||
return;
|
||||
|
||||
cm4000_detach_by_devno(i, link);
|
||||
link->state &= ~DEV_PRESENT;
|
||||
stop_monitor(dev);
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
cm4000_release(link);
|
||||
|
||||
dev_table[devno] = NULL;
|
||||
kfree(dev);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
@@ -2042,9 +1986,10 @@ static struct pcmcia_driver cm4000_driver = {
|
||||
.drv = {
|
||||
.name = "cm4000_cs",
|
||||
},
|
||||
.attach = cm4000_attach,
|
||||
.detach = cm4000_detach,
|
||||
.event = cm4000_event,
|
||||
.probe = cm4000_attach,
|
||||
.remove = cm4000_detach,
|
||||
.suspend = cm4000_suspend,
|
||||
.resume = cm4000_resume,
|
||||
.id_table = cm4000_ids,
|
||||
};
|
||||
|
||||
@@ -2064,13 +2009,8 @@ static int __init cmm_init(void)
|
||||
|
||||
static void __exit cmm_exit(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
printk(KERN_INFO MODULE_NAME ": unloading\n");
|
||||
pcmcia_unregister_driver(&cm4000_driver);
|
||||
for (i = 0; i < CM4000_MAX_DEV; i++)
|
||||
if (dev_table[i])
|
||||
cm4000_detach_by_devno(i, dev_table[i]);
|
||||
unregister_chrdev(major, DEVICE_NAME);
|
||||
};
|
||||
|
||||
|
||||
@@ -65,7 +65,6 @@ static char *version =
|
||||
#define POLL_PERIOD msecs_to_jiffies(10)
|
||||
|
||||
static void reader_release(dev_link_t *link);
|
||||
static void reader_detach(dev_link_t *link);
|
||||
|
||||
static int major;
|
||||
|
||||
@@ -86,7 +85,6 @@ struct reader_dev {
|
||||
struct timer_list poll_timer;
|
||||
};
|
||||
|
||||
static dev_info_t dev_info = MODULE_NAME;
|
||||
static dev_link_t *dev_table[CM_MAX_DEV];
|
||||
|
||||
#ifndef PCMCIA_DEBUG
|
||||
@@ -629,65 +627,26 @@ cs_release:
|
||||
link->state &= ~DEV_CONFIG_PENDING;
|
||||
}
|
||||
|
||||
static int reader_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int reader_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link;
|
||||
struct reader_dev *dev;
|
||||
int devno;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
link = args->client_data;
|
||||
dev = link->priv;
|
||||
DEBUGP(3, dev, "-> reader_event\n");
|
||||
for (devno = 0; devno < CM_MAX_DEV; devno++) {
|
||||
if (dev_table[devno] == link)
|
||||
break;
|
||||
}
|
||||
if (devno == CM_MAX_DEV)
|
||||
return CS_BAD_ADAPTER;
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_INSERTION\n");
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
reader_config(link, devno);
|
||||
break;
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_REMOVAL\n");
|
||||
link->state &= ~DEV_PRESENT;
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
DEBUGP(5, dev, "CS_EVENT_PM_SUSPEND "
|
||||
"(fall-through to CS_EVENT_RESET_PHYSICAL)\n");
|
||||
link->state |= DEV_SUSPEND;
|
||||
return 0;
|
||||
}
|
||||
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
DEBUGP(5, dev, "CS_EVENT_RESET_PHYSICAL\n");
|
||||
if (link->state & DEV_CONFIG) {
|
||||
DEBUGP(5, dev, "ReleaseConfiguration\n");
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
DEBUGP(5, dev, "CS_EVENT_PM_RESUME "
|
||||
"(fall-through to CS_EVENT_CARD_RESET)\n");
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
static int reader_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
case CS_EVENT_CARD_RESET:
|
||||
DEBUGP(5, dev, "CS_EVENT_CARD_RESET\n");
|
||||
if ((link->state & DEV_CONFIG)) {
|
||||
DEBUGP(5, dev, "RequestConfiguration\n");
|
||||
pcmcia_request_configuration(link->handle,
|
||||
&link->conf);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
DEBUGP(5, dev, "reader_event: unknown event %.2x\n",
|
||||
event);
|
||||
break;
|
||||
}
|
||||
DEBUGP(3, dev, "<- reader_event\n");
|
||||
return CS_SUCCESS;
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void reader_release(dev_link_t *link)
|
||||
@@ -697,11 +656,10 @@ static void reader_release(dev_link_t *link)
|
||||
pcmcia_release_io(link->handle, &link->io);
|
||||
}
|
||||
|
||||
static dev_link_t *reader_attach(void)
|
||||
static int reader_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
struct reader_dev *dev;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < CM_MAX_DEV; i++) {
|
||||
@@ -710,11 +668,11 @@ static dev_link_t *reader_attach(void)
|
||||
}
|
||||
|
||||
if (i == CM_MAX_DEV)
|
||||
return NULL;
|
||||
return -ENODEV;
|
||||
|
||||
dev = kzalloc(sizeof(struct reader_dev), GFP_KERNEL);
|
||||
if (dev == NULL)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
dev->timeout = CCID_DRIVER_MINIMUM_TIMEOUT;
|
||||
dev->buffer_status = 0;
|
||||
@@ -725,20 +683,6 @@ static dev_link_t *reader_attach(void)
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
dev_table[i] = link;
|
||||
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Attributes = INFO_IO_CLIENT | INFO_CARD_SHARE;
|
||||
client_reg.EventMask=
|
||||
CS_EVENT_CARD_INSERTION | CS_EVENT_CARD_REMOVAL |
|
||||
CS_EVENT_RESET_PHYSICAL | CS_EVENT_CARD_RESET |
|
||||
CS_EVENT_PM_SUSPEND | CS_EVENT_PM_RESUME;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
i = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (i) {
|
||||
cs_error(link->handle, RegisterClient, i);
|
||||
reader_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
init_waitqueue_head(&dev->devq);
|
||||
init_waitqueue_head(&dev->poll_wait);
|
||||
init_waitqueue_head(&dev->read_wait);
|
||||
@@ -746,39 +690,37 @@ static dev_link_t *reader_attach(void)
|
||||
init_timer(&dev->poll_timer);
|
||||
dev->poll_timer.function = &cm4040_do_poll;
|
||||
|
||||
return link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
reader_config(link, i);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void reader_detach_by_devno(int devno, dev_link_t *link)
|
||||
static void reader_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct reader_dev *dev = link->priv;
|
||||
|
||||
if (link->state & DEV_CONFIG) {
|
||||
DEBUGP(5, dev, "device still configured (try to release it)\n");
|
||||
reader_release(link);
|
||||
}
|
||||
|
||||
pcmcia_deregister_client(link->handle);
|
||||
dev_table[devno] = NULL;
|
||||
DEBUGP(5, dev, "freeing dev=%p\n", dev);
|
||||
cm4040_stop_poll(dev);
|
||||
kfree(dev);
|
||||
return;
|
||||
}
|
||||
|
||||
static void reader_detach(dev_link_t *link)
|
||||
{
|
||||
int i;
|
||||
int devno;
|
||||
|
||||
/* find device */
|
||||
for (i = 0; i < CM_MAX_DEV; i++) {
|
||||
if (dev_table[i] == link)
|
||||
for (devno = 0; devno < CM_MAX_DEV; devno++) {
|
||||
if (dev_table[devno] == link)
|
||||
break;
|
||||
}
|
||||
if (i == CM_MAX_DEV)
|
||||
if (devno == CM_MAX_DEV)
|
||||
return;
|
||||
|
||||
reader_detach_by_devno(i, link);
|
||||
link->state &= ~DEV_PRESENT;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
reader_release(link);
|
||||
|
||||
dev_table[devno] = NULL;
|
||||
kfree(dev);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
@@ -804,9 +746,10 @@ static struct pcmcia_driver reader_driver = {
|
||||
.drv = {
|
||||
.name = "cm4040_cs",
|
||||
},
|
||||
.attach = reader_attach,
|
||||
.detach = reader_detach,
|
||||
.event = reader_event,
|
||||
.probe = reader_attach,
|
||||
.remove = reader_detach,
|
||||
.suspend = reader_suspend,
|
||||
.resume = reader_resume,
|
||||
.id_table = cm4040_ids,
|
||||
};
|
||||
|
||||
@@ -825,14 +768,8 @@ static int __init cm4040_init(void)
|
||||
|
||||
static void __exit cm4040_exit(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
printk(KERN_INFO MODULE_NAME ": unloading\n");
|
||||
pcmcia_unregister_driver(&reader_driver);
|
||||
for (i = 0; i < CM_MAX_DEV; i++) {
|
||||
if (dev_table[i])
|
||||
reader_detach_by_devno(i, dev_table[i]);
|
||||
}
|
||||
unregister_chrdev(major, DEVICE_NAME);
|
||||
}
|
||||
|
||||
|
||||
@@ -486,13 +486,7 @@ static void mgslpc_wait_until_sent(struct tty_struct *tty, int timeout);
|
||||
|
||||
static void mgslpc_config(dev_link_t *link);
|
||||
static void mgslpc_release(u_long arg);
|
||||
static int mgslpc_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
static dev_link_t *mgslpc_attach(void);
|
||||
static void mgslpc_detach(dev_link_t *);
|
||||
|
||||
static dev_info_t dev_info = "synclink_cs";
|
||||
static dev_link_t *dev_list = NULL;
|
||||
static void mgslpc_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
* 1st function defined in .text section. Calling this function in
|
||||
@@ -539,12 +533,10 @@ static void ldisc_receive_buf(struct tty_struct *tty,
|
||||
}
|
||||
}
|
||||
|
||||
static dev_link_t *mgslpc_attach(void)
|
||||
static int mgslpc_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
MGSLPC_INFO *info;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int ret;
|
||||
|
||||
if (debug_level >= DEBUG_LEVEL_INFO)
|
||||
printk("mgslpc_attach\n");
|
||||
@@ -552,7 +544,7 @@ static dev_link_t *mgslpc_attach(void)
|
||||
info = (MGSLPC_INFO *)kmalloc(sizeof(MGSLPC_INFO), GFP_KERNEL);
|
||||
if (!info) {
|
||||
printk("Error can't allocate device instance data\n");
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
memset(info, 0, sizeof(MGSLPC_INFO));
|
||||
@@ -587,24 +579,15 @@ static dev_link_t *mgslpc_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
mgslpc_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
mgslpc_config(link);
|
||||
|
||||
mgslpc_add_device(info);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Card has been inserted.
|
||||
@@ -736,85 +719,50 @@ static void mgslpc_release(u_long arg)
|
||||
pcmcia_release_io(link->handle, &link->io);
|
||||
if (link->irq.AssignedIRQ)
|
||||
pcmcia_release_irq(link->handle, &link->irq);
|
||||
if (link->state & DEV_STALE_LINK)
|
||||
mgslpc_detach(link);
|
||||
}
|
||||
|
||||
static void mgslpc_detach(dev_link_t *link)
|
||||
static void mgslpc_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
if (debug_level >= DEBUG_LEVEL_INFO)
|
||||
printk("mgslpc_detach(0x%p)\n", link);
|
||||
|
||||
/* find device */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG) {
|
||||
/* device is configured/active, mark it so when
|
||||
* release() is called a proper detach() occurs.
|
||||
*/
|
||||
if (debug_level >= DEBUG_LEVEL_INFO)
|
||||
printk(KERN_DEBUG "synclinkpc: detach postponed, '%s' "
|
||||
"still locked\n", link->dev->dev_name);
|
||||
link->state |= DEV_STALE_LINK;
|
||||
return;
|
||||
((MGSLPC_INFO *)link->priv)->stop = 1;
|
||||
mgslpc_release((u_long)link);
|
||||
}
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, and free it */
|
||||
*linkp = link->next;
|
||||
mgslpc_remove_device((MGSLPC_INFO *)link->priv);
|
||||
}
|
||||
|
||||
static int mgslpc_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int mgslpc_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
MGSLPC_INFO *info = link->priv;
|
||||
|
||||
if (debug_level >= DEBUG_LEVEL_INFO)
|
||||
printk("mgslpc_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
((MGSLPC_INFO *)link->priv)->stop = 1;
|
||||
mgslpc_release((u_long)link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
mgslpc_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
/* Mark the device as stopped, to block IO until later */
|
||||
info->stop = 1;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
info->stop = 0;
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
MGSLPC_INFO *info = link->priv;
|
||||
|
||||
link->state |= DEV_SUSPEND;
|
||||
info->stop = 1;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mgslpc_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
MGSLPC_INFO *info = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
info->stop = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static inline int mgslpc_paranoia_check(MGSLPC_INFO *info,
|
||||
char *name, const char *routine)
|
||||
{
|
||||
@@ -3091,10 +3039,11 @@ static struct pcmcia_driver mgslpc_driver = {
|
||||
.drv = {
|
||||
.name = "synclink_cs",
|
||||
},
|
||||
.attach = mgslpc_attach,
|
||||
.event = mgslpc_event,
|
||||
.detach = mgslpc_detach,
|
||||
.probe = mgslpc_attach,
|
||||
.remove = mgslpc_detach,
|
||||
.id_table = mgslpc_ids,
|
||||
.suspend = mgslpc_suspend,
|
||||
.resume = mgslpc_resume,
|
||||
};
|
||||
|
||||
static struct tty_operations mgslpc_ops = {
|
||||
@@ -3138,7 +3087,6 @@ static void synclink_cs_cleanup(void)
|
||||
}
|
||||
|
||||
pcmcia_unregister_driver(&mgslpc_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
static int __init synclink_cs_init(void)
|
||||
|
||||
@@ -88,15 +88,12 @@ typedef struct ide_info_t {
|
||||
} ide_info_t;
|
||||
|
||||
static void ide_release(dev_link_t *);
|
||||
static int ide_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
static void ide_config(dev_link_t *);
|
||||
|
||||
static void ide_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
static dev_info_t dev_info = "ide-cs";
|
||||
|
||||
static dev_link_t *ide_attach(void);
|
||||
static void ide_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*======================================================================
|
||||
|
||||
@@ -106,18 +103,17 @@ static dev_link_t *dev_list = NULL;
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *ide_attach(void)
|
||||
static int ide_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
ide_info_t *info;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int ret;
|
||||
|
||||
|
||||
DEBUG(0, "ide_attach()\n");
|
||||
|
||||
/* Create new ide device */
|
||||
info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||
if (!info) return NULL;
|
||||
if (!info)
|
||||
return -ENOMEM;
|
||||
link = &info->link; link->priv = info;
|
||||
|
||||
link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
|
||||
@@ -128,21 +124,14 @@ static dev_link_t *ide_attach(void)
|
||||
link->conf.Attributes = CONF_ENABLE_IRQ;
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
ide_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
return link;
|
||||
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
ide_config(link);
|
||||
|
||||
return 0;
|
||||
} /* ide_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -154,32 +143,16 @@ static dev_link_t *ide_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void ide_detach(dev_link_t *link)
|
||||
static void ide_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
int ret;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
DEBUG(0, "ide_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
ide_release(link);
|
||||
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
/* Unlink, free device structure */
|
||||
*linkp = link->next;
|
||||
|
||||
kfree(link->priv);
|
||||
|
||||
} /* ide_detach */
|
||||
|
||||
static int idecs_register(unsigned long io, unsigned long ctl, unsigned long irq, struct pcmcia_device *handle)
|
||||
@@ -406,6 +379,28 @@ void ide_release(dev_link_t *link)
|
||||
|
||||
} /* ide_release */
|
||||
|
||||
static int ide_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ide_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
@@ -415,48 +410,15 @@ void ide_release(dev_link_t *link)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
int ide_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
|
||||
DEBUG(1, "ide_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
ide_release(link);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
ide_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (DEV_OK(link))
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* ide_event */
|
||||
|
||||
static struct pcmcia_device_id ide_ids[] = {
|
||||
PCMCIA_DEVICE_FUNC_ID(4),
|
||||
PCMCIA_DEVICE_MANF_CARD(0x0007, 0x0000), /* Hitachi */
|
||||
PCMCIA_DEVICE_MANF_CARD(0x0032, 0x0704),
|
||||
PCMCIA_DEVICE_MANF_CARD(0x0045, 0x0401),
|
||||
PCMCIA_DEVICE_MANF_CARD(0x0098, 0x0000), /* Toshiba */
|
||||
PCMCIA_DEVICE_MANF_CARD(0x00a4, 0x002d),
|
||||
PCMCIA_DEVICE_MANF_CARD(0x00ce, 0x0000), /* Samsung */
|
||||
PCMCIA_DEVICE_MANF_CARD(0x0319, 0x0000), /* Hitachi */
|
||||
PCMCIA_DEVICE_MANF_CARD(0x2080, 0x0001),
|
||||
PCMCIA_DEVICE_MANF_CARD(0x4e01, 0x0200), /* Lexar */
|
||||
PCMCIA_DEVICE_PROD_ID123("Caravelle", "PSC-IDE ", "PSC000", 0x8c36137c, 0xd0693ab8, 0x2768a9f0),
|
||||
@@ -471,6 +433,8 @@ static struct pcmcia_device_id ide_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("EXP ", "CD-ROM", 0x0a5c52fd, 0x66536591),
|
||||
PCMCIA_DEVICE_PROD_ID12("EXP ", "PnPIDE", 0x0a5c52fd, 0x0c694728),
|
||||
PCMCIA_DEVICE_PROD_ID12("FREECOM", "PCCARD-IDE", 0x5714cbf7, 0x48e0ab8e),
|
||||
PCMCIA_DEVICE_PROD_ID12("HITACHI", "FLASH", 0xf4f43949, 0x9eb86aae),
|
||||
PCMCIA_DEVICE_PROD_ID12("HITACHI", "microdrive", 0xf4f43949, 0xa6d76178),
|
||||
PCMCIA_DEVICE_PROD_ID12("IBM", "IBM17JSSFP20", 0xb569a6e5, 0xf2508753),
|
||||
PCMCIA_DEVICE_PROD_ID12("IO DATA", "CBIDE2 ", 0x547e66dc, 0x8671043b),
|
||||
PCMCIA_DEVICE_PROD_ID12("IO DATA", "PCIDE", 0x547e66dc, 0x5c5ab149),
|
||||
@@ -494,10 +458,11 @@ static struct pcmcia_driver ide_cs_driver = {
|
||||
.drv = {
|
||||
.name = "ide-cs",
|
||||
},
|
||||
.attach = ide_attach,
|
||||
.event = ide_event,
|
||||
.detach = ide_detach,
|
||||
.probe = ide_attach,
|
||||
.remove = ide_detach,
|
||||
.id_table = ide_ids,
|
||||
.suspend = ide_suspend,
|
||||
.resume = ide_resume,
|
||||
};
|
||||
|
||||
static int __init init_ide_cs(void)
|
||||
@@ -508,7 +473,6 @@ static int __init init_ide_cs(void)
|
||||
static void __exit exit_ide_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&ide_cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
late_initcall(init_ide_cs);
|
||||
|
||||
@@ -53,8 +53,6 @@ MODULE_LICENSE("GPL");
|
||||
|
||||
static void avmcs_config(dev_link_t *link);
|
||||
static void avmcs_release(dev_link_t *link);
|
||||
static int avmcs_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
@@ -62,16 +60,7 @@ static int avmcs_event(event_t event, int priority,
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static dev_link_t *avmcs_attach(void);
|
||||
static void avmcs_detach(dev_link_t *);
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static dev_info_t dev_info = "avm_cs";
|
||||
static void avmcs_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
A linked list of "instances" of the skeleton device. Each actual
|
||||
@@ -83,15 +72,7 @@ static dev_info_t dev_info = "avm_cs";
|
||||
device numbers are used to derive the corresponding array index.
|
||||
*/
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*
|
||||
A dev_link_t structure has fields for most things that are needed
|
||||
to keep track of a socket, but there will usually be some device
|
||||
specific information that also needs to be kept track of. The
|
||||
'priv' pointer in a dev_link_t structure can be used to point to
|
||||
a device-specific private data structure, like this.
|
||||
|
||||
A driver needs to provide a dev_node_t structure for each device
|
||||
on a card. In some cases, there is only one device per card (for
|
||||
example, ethernet cards, modems). In other cases, there may be
|
||||
@@ -118,13 +99,11 @@ typedef struct local_info_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *avmcs_attach(void)
|
||||
static int avmcs_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
local_info_t *local;
|
||||
int ret;
|
||||
|
||||
|
||||
/* Initialize the dev_link_t structure */
|
||||
link = kmalloc(sizeof(struct dev_link_t), GFP_KERNEL);
|
||||
if (!link)
|
||||
@@ -155,25 +134,19 @@ static dev_link_t *avmcs_attach(void)
|
||||
goto err_kfree;
|
||||
memset(local, 0, sizeof(local_info_t));
|
||||
link->priv = local;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
avmcs_detach(link);
|
||||
goto err;
|
||||
}
|
||||
return link;
|
||||
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
avmcs_config(link);
|
||||
|
||||
return 0;
|
||||
|
||||
err_kfree:
|
||||
kfree(link);
|
||||
err:
|
||||
return NULL;
|
||||
return -EINVAL;
|
||||
} /* avmcs_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -185,33 +158,13 @@ static dev_link_t *avmcs_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void avmcs_detach(dev_link_t *link)
|
||||
static void avmcs_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
if (link->state & DEV_CONFIG)
|
||||
avmcs_release(link);
|
||||
|
||||
/*
|
||||
If the device is currently configured and active, we won't
|
||||
actually delete it yet. Instead, it is marked so that when
|
||||
the release() function is called, that will trigger a proper
|
||||
detach().
|
||||
*/
|
||||
if (link->state & DEV_CONFIG) {
|
||||
link->state |= DEV_STALE_LINK;
|
||||
return;
|
||||
}
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free pieces */
|
||||
*linkp = link->next;
|
||||
kfree(link->priv);
|
||||
kfree(link);
|
||||
} /* avmcs_detach */
|
||||
@@ -424,12 +377,30 @@ static void avmcs_release(dev_link_t *link)
|
||||
pcmcia_release_io(link->handle, &link->io);
|
||||
pcmcia_release_irq(link->handle, &link->irq);
|
||||
link->state &= ~DEV_CONFIG;
|
||||
|
||||
if (link->state & DEV_STALE_LINK)
|
||||
avmcs_detach(link);
|
||||
|
||||
} /* avmcs_release */
|
||||
|
||||
static int avmcs_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int avmcs_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
@@ -444,38 +415,6 @@ static void avmcs_release(dev_link_t *link)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int avmcs_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
avmcs_release(link);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
avmcs_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* avmcs_event */
|
||||
|
||||
static struct pcmcia_device_id avmcs_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
|
||||
@@ -490,10 +429,11 @@ static struct pcmcia_driver avmcs_driver = {
|
||||
.drv = {
|
||||
.name = "avm_cs",
|
||||
},
|
||||
.attach = avmcs_attach,
|
||||
.event = avmcs_event,
|
||||
.detach = avmcs_detach,
|
||||
.probe = avmcs_attach,
|
||||
.remove = avmcs_detach,
|
||||
.id_table = avmcs_ids,
|
||||
.suspend= avmcs_suspend,
|
||||
.resume = avmcs_resume,
|
||||
};
|
||||
|
||||
static int __init avmcs_init(void)
|
||||
@@ -504,7 +444,6 @@ static int __init avmcs_init(void)
|
||||
static void __exit avmcs_exit(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&avmcs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(avmcs_init);
|
||||
|
||||
@@ -69,8 +69,6 @@ module_param(isdnprot, int, 0);
|
||||
|
||||
static void avma1cs_config(dev_link_t *link);
|
||||
static void avma1cs_release(dev_link_t *link);
|
||||
static int avma1cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
@@ -78,16 +76,8 @@ static int avma1cs_event(event_t event, int priority,
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static dev_link_t *avma1cs_attach(void);
|
||||
static void avma1cs_detach(dev_link_t *);
|
||||
static void avma1cs_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static dev_info_t dev_info = "avma1_cs";
|
||||
|
||||
/*
|
||||
A linked list of "instances" of the skeleton device. Each actual
|
||||
@@ -99,15 +89,7 @@ static dev_info_t dev_info = "avma1_cs";
|
||||
device numbers are used to derive the corresponding array index.
|
||||
*/
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*
|
||||
A dev_link_t structure has fields for most things that are needed
|
||||
to keep track of a socket, but there will usually be some device
|
||||
specific information that also needs to be kept track of. The
|
||||
'priv' pointer in a dev_link_t structure can be used to point to
|
||||
a device-specific private data structure, like this.
|
||||
|
||||
A driver needs to provide a dev_node_t structure for each device
|
||||
on a card. In some cases, there is only one device per card (for
|
||||
example, ethernet cards, modems). In other cases, there may be
|
||||
@@ -134,26 +116,24 @@ typedef struct local_info_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *avma1cs_attach(void)
|
||||
static int avma1cs_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
local_info_t *local;
|
||||
int ret;
|
||||
|
||||
|
||||
DEBUG(0, "avma1cs_attach()\n");
|
||||
|
||||
/* Initialize the dev_link_t structure */
|
||||
link = kmalloc(sizeof(struct dev_link_t), GFP_KERNEL);
|
||||
if (!link)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
memset(link, 0, sizeof(struct dev_link_t));
|
||||
|
||||
/* Allocate space for private device-specific data */
|
||||
local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
|
||||
if (!local) {
|
||||
kfree(link);
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
}
|
||||
memset(local, 0, sizeof(local_info_t));
|
||||
link->priv = local;
|
||||
@@ -178,20 +158,13 @@ static dev_link_t *avma1cs_attach(void)
|
||||
link->conf.ConfigIndex = 1;
|
||||
link->conf.Present = PRESENT_OPTION;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
avma1cs_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
avma1cs_config(link);
|
||||
|
||||
return 0;
|
||||
} /* avma1cs_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -203,42 +176,17 @@ static dev_link_t *avma1cs_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void avma1cs_detach(dev_link_t *link)
|
||||
static void avma1cs_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
DEBUG(0, "avma1cs_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
/*
|
||||
If the device is currently configured and active, we won't
|
||||
actually delete it yet. Instead, it is marked so that when
|
||||
the release() function is called, that will trigger a proper
|
||||
detach().
|
||||
*/
|
||||
if (link->state & DEV_CONFIG) {
|
||||
#ifdef PCMCIA_DEBUG
|
||||
printk(KERN_DEBUG "avma1_cs: detach postponed, '%s' "
|
||||
"still locked\n", link->dev->dev_name);
|
||||
#endif
|
||||
link->state |= DEV_STALE_LINK;
|
||||
return;
|
||||
}
|
||||
if (link->state & DEV_CONFIG)
|
||||
avma1cs_release(link);
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free pieces */
|
||||
*linkp = link->next;
|
||||
kfree(link->priv);
|
||||
kfree(link);
|
||||
|
||||
} /* avma1cs_detach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -440,58 +388,30 @@ static void avma1cs_release(dev_link_t *link)
|
||||
pcmcia_release_io(link->handle, &link->io);
|
||||
pcmcia_release_irq(link->handle, &link->irq);
|
||||
link->state &= ~DEV_CONFIG;
|
||||
|
||||
if (link->state & DEV_STALE_LINK)
|
||||
avma1cs_detach(link);
|
||||
} /* avma1cs_release */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
When a CARD_REMOVAL event is received, we immediately set a flag
|
||||
to block future accesses to this device. All the functions that
|
||||
actually access the device should check this flag to make sure
|
||||
the card is still present.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int avma1cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int avma1cs_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
DEBUG(1, "avma1cs_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
avma1cs_release(link);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
avma1cs_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG)
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int avma1cs_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(dev);
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* avma1cs_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id avma1cs_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN A", 0x95d42008, 0xadc9d4bb),
|
||||
@@ -505,10 +425,11 @@ static struct pcmcia_driver avma1cs_driver = {
|
||||
.drv = {
|
||||
.name = "avma1_cs",
|
||||
},
|
||||
.attach = avma1cs_attach,
|
||||
.event = avma1cs_event,
|
||||
.detach = avma1cs_detach,
|
||||
.probe = avma1cs_attach,
|
||||
.remove = avma1cs_detach,
|
||||
.id_table = avma1cs_ids,
|
||||
.suspend = avma1cs_suspend,
|
||||
.resume = avma1cs_resume,
|
||||
};
|
||||
|
||||
/*====================================================================*/
|
||||
@@ -521,7 +442,6 @@ static int __init init_avma1_cs(void)
|
||||
static void __exit exit_avma1_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&avma1cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_avma1_cs);
|
||||
|
||||
@@ -96,8 +96,6 @@ module_param(protocol, int, 0);
|
||||
|
||||
static void elsa_cs_config(dev_link_t *link);
|
||||
static void elsa_cs_release(dev_link_t *link);
|
||||
static int elsa_cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
@@ -105,39 +103,9 @@ static int elsa_cs_event(event_t event, int priority,
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static dev_link_t *elsa_cs_attach(void);
|
||||
static void elsa_cs_detach(dev_link_t *);
|
||||
static void elsa_cs_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static dev_info_t dev_info = "elsa_cs";
|
||||
|
||||
/*
|
||||
A linked list of "instances" of the elsa_cs device. Each actual
|
||||
PCMCIA card corresponds to one device instance, and is described
|
||||
by one dev_link_t structure (defined in ds.h).
|
||||
|
||||
You may not want to use a linked list for this -- for example, the
|
||||
memory card driver uses an array of dev_link_t pointers, where minor
|
||||
device numbers are used to derive the corresponding array index.
|
||||
*/
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*
|
||||
A dev_link_t structure has fields for most things that are needed
|
||||
to keep track of a socket, but there will usually be some device
|
||||
specific information that also needs to be kept track of. The
|
||||
'priv' pointer in a dev_link_t structure can be used to point to
|
||||
a device-specific private data structure, like this.
|
||||
|
||||
To simplify the data structure handling, we actually include the
|
||||
dev_link_t structure in the device's private data structure.
|
||||
|
||||
A driver needs to provide a dev_node_t structure for each device
|
||||
on a card. In some cases, there is only one device per card (for
|
||||
example, ethernet cards, modems). In other cases, there may be
|
||||
@@ -171,18 +139,16 @@ typedef struct local_info_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *elsa_cs_attach(void)
|
||||
static int elsa_cs_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
local_info_t *local;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "elsa_cs_attach()\n");
|
||||
|
||||
/* Allocate space for private device-specific data */
|
||||
local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
|
||||
if (!local) return NULL;
|
||||
if (!local) return -ENOMEM;
|
||||
memset(local, 0, sizeof(local_info_t));
|
||||
local->cardnr = -1;
|
||||
link = &local->link; link->priv = local;
|
||||
@@ -207,20 +173,13 @@ static dev_link_t *elsa_cs_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
elsa_cs_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
elsa_cs_config(link);
|
||||
|
||||
return 0;
|
||||
} /* elsa_cs_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -232,32 +191,18 @@ static dev_link_t *elsa_cs_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void elsa_cs_detach(dev_link_t *link)
|
||||
static void elsa_cs_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *info = link->priv;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "elsa_cs_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
elsa_cs_release(link);
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
if (link->state & DEV_CONFIG) {
|
||||
info->busy = 1;
|
||||
elsa_cs_release(link);
|
||||
}
|
||||
|
||||
/* Unlink device structure and free it */
|
||||
*linkp = link->next;
|
||||
kfree(info);
|
||||
|
||||
} /* elsa_cs_detach */
|
||||
@@ -447,60 +392,31 @@ static void elsa_cs_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
} /* elsa_cs_release */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
When a CARD_REMOVAL event is received, we immediately set a flag
|
||||
to block future accesses to this device. All the functions that
|
||||
actually access the device should check this flag to make sure
|
||||
the card is still present.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int elsa_cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int elsa_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
local_info_t *dev = link->priv;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
DEBUG(1, "elsa_cs_event(%d)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
((local_info_t*)link->priv)->busy = 1;
|
||||
elsa_cs_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
elsa_cs_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
/* Mark the device as stopped, to block IO until later */
|
||||
link->state |= DEV_SUSPEND;
|
||||
dev->busy = 1;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int elsa_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
dev->busy = 0;
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* elsa_cs_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct pcmcia_device_id elsa_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("ELSA AG (Aachen, Germany)", "MicroLink ISDN/MC ", 0x983de2c4, 0x333ba257),
|
||||
@@ -514,10 +430,11 @@ static struct pcmcia_driver elsa_cs_driver = {
|
||||
.drv = {
|
||||
.name = "elsa_cs",
|
||||
},
|
||||
.attach = elsa_cs_attach,
|
||||
.event = elsa_cs_event,
|
||||
.detach = elsa_cs_detach,
|
||||
.probe = elsa_cs_attach,
|
||||
.remove = elsa_cs_detach,
|
||||
.id_table = elsa_ids,
|
||||
.suspend = elsa_suspend,
|
||||
.resume = elsa_resume,
|
||||
};
|
||||
|
||||
static int __init init_elsa_cs(void)
|
||||
@@ -528,7 +445,6 @@ static int __init init_elsa_cs(void)
|
||||
static void __exit exit_elsa_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&elsa_cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_elsa_cs);
|
||||
|
||||
@@ -97,8 +97,6 @@ module_param(protocol, int, 0);
|
||||
|
||||
static void sedlbauer_config(dev_link_t *link);
|
||||
static void sedlbauer_release(dev_link_t *link);
|
||||
static int sedlbauer_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
@@ -106,8 +104,7 @@ static int sedlbauer_event(event_t event, int priority,
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static dev_link_t *sedlbauer_attach(void);
|
||||
static void sedlbauer_detach(dev_link_t *);
|
||||
static void sedlbauer_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
You'll also need to prototype all the functions that will actually
|
||||
@@ -117,35 +114,6 @@ static void sedlbauer_detach(dev_link_t *);
|
||||
*/
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static dev_info_t dev_info = "sedlbauer_cs";
|
||||
|
||||
/*
|
||||
A linked list of "instances" of the sedlbauer device. Each actual
|
||||
PCMCIA card corresponds to one device instance, and is described
|
||||
by one dev_link_t structure (defined in ds.h).
|
||||
|
||||
You may not want to use a linked list for this -- for example, the
|
||||
memory card driver uses an array of dev_link_t pointers, where minor
|
||||
device numbers are used to derive the corresponding array index.
|
||||
*/
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*
|
||||
A dev_link_t structure has fields for most things that are needed
|
||||
to keep track of a socket, but there will usually be some device
|
||||
specific information that also needs to be kept track of. The
|
||||
'priv' pointer in a dev_link_t structure can be used to point to
|
||||
a device-specific private data structure, like this.
|
||||
|
||||
To simplify the data structure handling, we actually include the
|
||||
dev_link_t structure in the device's private data structure.
|
||||
|
||||
A driver needs to provide a dev_node_t structure for each device
|
||||
on a card. In some cases, there is only one device per card (for
|
||||
example, ethernet cards, modems). In other cases, there may be
|
||||
@@ -180,18 +148,16 @@ typedef struct local_info_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *sedlbauer_attach(void)
|
||||
static int sedlbauer_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
local_info_t *local;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "sedlbauer_attach()\n");
|
||||
|
||||
/* Allocate space for private device-specific data */
|
||||
local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
|
||||
if (!local) return NULL;
|
||||
if (!local) return -ENOMEM;
|
||||
memset(local, 0, sizeof(local_info_t));
|
||||
local->cardnr = -1;
|
||||
link = &local->link; link->priv = local;
|
||||
@@ -221,20 +187,13 @@ static dev_link_t *sedlbauer_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
sedlbauer_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
sedlbauer_config(link);
|
||||
|
||||
return 0;
|
||||
} /* sedlbauer_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -246,39 +205,17 @@ static dev_link_t *sedlbauer_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void sedlbauer_detach(dev_link_t *link)
|
||||
static void sedlbauer_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
DEBUG(0, "sedlbauer_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
/*
|
||||
If the device is currently configured and active, we won't
|
||||
actually delete it yet. Instead, it is marked so that when
|
||||
the release() function is called, that will trigger a proper
|
||||
detach().
|
||||
*/
|
||||
if (link->state & DEV_CONFIG) {
|
||||
#ifdef PCMCIA_DEBUG
|
||||
printk(KERN_DEBUG "sedlbauer_cs: detach postponed, '%s' "
|
||||
"still locked\n", link->dev->dev_name);
|
||||
#endif
|
||||
link->state |= DEV_STALE_LINK;
|
||||
return;
|
||||
((local_info_t *)link->priv)->stop = 1;
|
||||
sedlbauer_release(link);
|
||||
}
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, and free it */
|
||||
*linkp = link->next;
|
||||
/* This points to the parent local_info_t struct */
|
||||
kfree(link->priv);
|
||||
} /* sedlbauer_detach */
|
||||
@@ -547,68 +484,34 @@ static void sedlbauer_release(dev_link_t *link)
|
||||
if (link->irq.AssignedIRQ)
|
||||
pcmcia_release_irq(link->handle, &link->irq);
|
||||
link->state &= ~DEV_CONFIG;
|
||||
|
||||
if (link->state & DEV_STALE_LINK)
|
||||
sedlbauer_detach(link);
|
||||
|
||||
} /* sedlbauer_release */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received.
|
||||
|
||||
When a CARD_REMOVAL event is received, we immediately set a
|
||||
private flag to block future accesses to this device. All the
|
||||
functions that actually access the device should check this flag
|
||||
to make sure the card is still present.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int sedlbauer_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int sedlbauer_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
DEBUG(1, "sedlbauer_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
((local_info_t *)link->priv)->stop = 1;
|
||||
sedlbauer_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
sedlbauer_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
/* Mark the device as stopped, to block IO until later */
|
||||
dev->stop = 1;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int sedlbauer_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
dev->stop = 0;
|
||||
/*
|
||||
In a normal driver, additional code may go here to restore
|
||||
the device state and restart IO.
|
||||
*/
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* sedlbauer_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id sedlbauer_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID123("SEDLBAUER", "speed star II", "V 3.1", 0x81fb79f5, 0xf3612e1d, 0x6b95c78a),
|
||||
@@ -627,10 +530,11 @@ static struct pcmcia_driver sedlbauer_driver = {
|
||||
.drv = {
|
||||
.name = "sedlbauer_cs",
|
||||
},
|
||||
.attach = sedlbauer_attach,
|
||||
.event = sedlbauer_event,
|
||||
.detach = sedlbauer_detach,
|
||||
.probe = sedlbauer_attach,
|
||||
.remove = sedlbauer_detach,
|
||||
.id_table = sedlbauer_ids,
|
||||
.suspend = sedlbauer_suspend,
|
||||
.resume = sedlbauer_resume,
|
||||
};
|
||||
|
||||
static int __init init_sedlbauer_cs(void)
|
||||
@@ -641,7 +545,6 @@ static int __init init_sedlbauer_cs(void)
|
||||
static void __exit exit_sedlbauer_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&sedlbauer_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_sedlbauer_cs);
|
||||
|
||||
@@ -77,8 +77,6 @@ module_param(protocol, int, 0);
|
||||
|
||||
static void teles_cs_config(dev_link_t *link);
|
||||
static void teles_cs_release(dev_link_t *link);
|
||||
static int teles_cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
/*
|
||||
The attach() and detach() entry points are used to create and destroy
|
||||
@@ -86,16 +84,7 @@ static int teles_cs_event(event_t event, int priority,
|
||||
needed to manage one actual PCMCIA card.
|
||||
*/
|
||||
|
||||
static dev_link_t *teles_attach(void);
|
||||
static void teles_detach(dev_link_t *);
|
||||
|
||||
/*
|
||||
The dev_info variable is the "key" that is used to match up this
|
||||
device driver with appropriate cards, through the card configuration
|
||||
database.
|
||||
*/
|
||||
|
||||
static dev_info_t dev_info = "teles_cs";
|
||||
static void teles_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
A linked list of "instances" of the teles_cs device. Each actual
|
||||
@@ -107,18 +96,7 @@ static dev_info_t dev_info = "teles_cs";
|
||||
device numbers are used to derive the corresponding array index.
|
||||
*/
|
||||
|
||||
static dev_link_t *dev_list = NULL;
|
||||
|
||||
/*
|
||||
A dev_link_t structure has fields for most things that are needed
|
||||
to keep track of a socket, but there will usually be some device
|
||||
specific information that also needs to be kept track of. The
|
||||
'priv' pointer in a dev_link_t structure can be used to point to
|
||||
a device-specific private data structure, like this.
|
||||
|
||||
To simplify the data structure handling, we actually include the
|
||||
dev_link_t structure in the device's private data structure.
|
||||
|
||||
A driver needs to provide a dev_node_t structure for each device
|
||||
on a card. In some cases, there is only one device per card (for
|
||||
example, ethernet cards, modems). In other cases, there may be
|
||||
@@ -152,18 +130,16 @@ typedef struct local_info_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *teles_attach(void)
|
||||
static int teles_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
local_info_t *local;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "teles_attach()\n");
|
||||
|
||||
/* Allocate space for private device-specific data */
|
||||
local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
|
||||
if (!local) return NULL;
|
||||
if (!local) return -ENOMEM;
|
||||
memset(local, 0, sizeof(local_info_t));
|
||||
local->cardnr = -1;
|
||||
link = &local->link; link->priv = local;
|
||||
@@ -188,20 +164,13 @@ static dev_link_t *teles_attach(void)
|
||||
link->conf.Vcc = 50;
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
teles_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
teles_cs_config(link);
|
||||
|
||||
return 0;
|
||||
} /* teles_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -213,32 +182,18 @@ static dev_link_t *teles_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void teles_detach(dev_link_t *link)
|
||||
static void teles_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t **linkp;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *info = link->priv;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "teles_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
teles_cs_release(link);
|
||||
|
||||
/* Break the link with Card Services */
|
||||
if (link->handle) {
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
if (link->state & DEV_CONFIG) {
|
||||
info->busy = 1;
|
||||
teles_cs_release(link);
|
||||
}
|
||||
|
||||
/* Unlink device structure and free it */
|
||||
*linkp = link->next;
|
||||
kfree(info);
|
||||
|
||||
} /* teles_detach */
|
||||
@@ -428,60 +383,32 @@ static void teles_cs_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
} /* teles_cs_release */
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
When a CARD_REMOVAL event is received, we immediately set a flag
|
||||
to block future accesses to this device. All the functions that
|
||||
actually access the device should check this flag to make sure
|
||||
the card is still present.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int teles_cs_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int teles_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
local_info_t *dev = link->priv;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
DEBUG(1, "teles_cs_event(%d)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
((local_info_t*)link->priv)->busy = 1;
|
||||
teles_cs_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
teles_cs_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
/* Mark the device as stopped, to block IO until later */
|
||||
link->state |= DEV_SUSPEND;
|
||||
dev->busy = 1;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_release_configuration(link->handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int teles_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
local_info_t *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG)
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
dev->busy = 0;
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* teles_cs_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static struct pcmcia_device_id teles_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("TELES", "S0/PC", 0x67b50eae, 0xe9e70119),
|
||||
@@ -494,10 +421,11 @@ static struct pcmcia_driver teles_cs_driver = {
|
||||
.drv = {
|
||||
.name = "teles_cs",
|
||||
},
|
||||
.attach = teles_attach,
|
||||
.event = teles_cs_event,
|
||||
.detach = teles_detach,
|
||||
.probe = teles_attach,
|
||||
.remove = teles_detach,
|
||||
.id_table = teles_ids,
|
||||
.suspend = teles_suspend,
|
||||
.resume = teles_resume,
|
||||
};
|
||||
|
||||
static int __init init_teles_cs(void)
|
||||
@@ -508,7 +436,6 @@ static int __init init_teles_cs(void)
|
||||
static void __exit exit_teles_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&teles_cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_teles_cs);
|
||||
|
||||
@@ -66,9 +66,6 @@ struct pcmciamtd_dev {
|
||||
};
|
||||
|
||||
|
||||
static dev_info_t dev_info = "pcmciamtd";
|
||||
static dev_link_t *dev_list;
|
||||
|
||||
/* Module parameters */
|
||||
|
||||
/* 2 = do 16-bit transfers, 1 = do 8-bit transfers */
|
||||
@@ -691,55 +688,21 @@ static void pcmciamtd_config(dev_link_t *link)
|
||||
}
|
||||
|
||||
|
||||
/* The card status event handler. Mostly, this schedules other
|
||||
* stuff to run after an event is received. A CARD_REMOVAL event
|
||||
* also sets some flags to discourage the driver from trying
|
||||
* to talk to the card any more.
|
||||
*/
|
||||
|
||||
static int pcmciamtd_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int pcmciamtd_suspend(struct pcmcia_device *dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
DEBUG(2, "EVENT_PM_RESUME");
|
||||
|
||||
/* get_lock(link); */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int pcmciamtd_resume(struct pcmcia_device *dev)
|
||||
{
|
||||
DEBUG(2, "EVENT_PM_SUSPEND");
|
||||
|
||||
/* free_lock(link); */
|
||||
|
||||
DEBUG(1, "event=0x%06x", event);
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
DEBUG(2, "EVENT_CARD_REMOVAL");
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
struct pcmciamtd_dev *dev = link->priv;
|
||||
if(dev->mtd_info) {
|
||||
del_mtd_device(dev->mtd_info);
|
||||
info("mtd%d: Removed", dev->mtd_info->index);
|
||||
}
|
||||
pcmciamtd_release(link);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
DEBUG(2, "EVENT_CARD_INSERTION");
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
pcmciamtd_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
DEBUG(2, "EVENT_PM_SUSPEND");
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
DEBUG(2, "EVENT_RESET_PHYSICAL");
|
||||
/* get_lock(link); */
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
DEBUG(2, "EVENT_PM_RESUME");
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
DEBUG(2, "EVENT_CARD_RESET");
|
||||
/* free_lock(link); */
|
||||
break;
|
||||
default:
|
||||
DEBUG(2, "Unknown event %d", event);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -750,23 +713,21 @@ static int pcmciamtd_event(event_t event, int priority,
|
||||
* when the device is released.
|
||||
*/
|
||||
|
||||
static void pcmciamtd_detach(dev_link_t *link)
|
||||
static void pcmciamtd_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
|
||||
DEBUG(3, "link=0x%p", link);
|
||||
|
||||
if(link->state & DEV_CONFIG) {
|
||||
struct pcmciamtd_dev *dev = link->priv;
|
||||
if(dev->mtd_info) {
|
||||
del_mtd_device(dev->mtd_info);
|
||||
info("mtd%d: Removed", dev->mtd_info->index);
|
||||
}
|
||||
|
||||
pcmciamtd_release(link);
|
||||
}
|
||||
|
||||
if (link->handle) {
|
||||
int ret;
|
||||
DEBUG(2, "Deregistering with card services");
|
||||
ret = pcmcia_deregister_client(link->handle);
|
||||
if (ret != CS_SUCCESS)
|
||||
cs_error(link->handle, DeregisterClient, ret);
|
||||
}
|
||||
|
||||
link->state |= DEV_STALE_LINK;
|
||||
}
|
||||
|
||||
|
||||
@@ -775,16 +736,14 @@ static void pcmciamtd_detach(dev_link_t *link)
|
||||
* with Card Services.
|
||||
*/
|
||||
|
||||
static dev_link_t *pcmciamtd_attach(void)
|
||||
static int pcmciamtd_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
struct pcmciamtd_dev *dev;
|
||||
dev_link_t *link;
|
||||
client_reg_t client_reg;
|
||||
int ret;
|
||||
|
||||
/* Create new memory card device */
|
||||
dev = kmalloc(sizeof(*dev), GFP_KERNEL);
|
||||
if (!dev) return NULL;
|
||||
if (!dev) return -ENOMEM;
|
||||
DEBUG(1, "dev=0x%p", dev);
|
||||
|
||||
memset(dev, 0, sizeof(*dev));
|
||||
@@ -794,22 +753,14 @@ static dev_link_t *pcmciamtd_attach(void)
|
||||
link->conf.Attributes = 0;
|
||||
link->conf.IntType = INT_MEMORY;
|
||||
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
link->next = NULL;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
/* Register with Card Services */
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
DEBUG(2, "Calling RegisterClient");
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
pcmciamtd_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
DEBUG(2, "link = %p", link);
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
pcmciamtd_config(link);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct pcmcia_device_id pcmciamtd_ids[] = {
|
||||
@@ -843,11 +794,12 @@ static struct pcmcia_driver pcmciamtd_driver = {
|
||||
.drv = {
|
||||
.name = "pcmciamtd"
|
||||
},
|
||||
.attach = pcmciamtd_attach,
|
||||
.event = pcmciamtd_event,
|
||||
.detach = pcmciamtd_detach,
|
||||
.probe = pcmciamtd_attach,
|
||||
.remove = pcmciamtd_detach,
|
||||
.owner = THIS_MODULE,
|
||||
.id_table = pcmciamtd_ids,
|
||||
.suspend = pcmciamtd_suspend,
|
||||
.resume = pcmciamtd_resume,
|
||||
};
|
||||
|
||||
|
||||
@@ -875,7 +827,6 @@ static void __exit exit_pcmciamtd(void)
|
||||
{
|
||||
DEBUG(1, DRIVER_DESC " unloading");
|
||||
pcmcia_unregister_driver(&pcmciamtd_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_pcmciamtd);
|
||||
|
||||
@@ -227,8 +227,6 @@ static char mii_preamble_required = 0;
|
||||
|
||||
static void tc574_config(dev_link_t *link);
|
||||
static void tc574_release(dev_link_t *link);
|
||||
static int tc574_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
static void mdio_sync(kio_addr_t ioaddr, int bits);
|
||||
static int mdio_read(kio_addr_t ioaddr, int phy_id, int location);
|
||||
@@ -250,12 +248,7 @@ static int el3_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
|
||||
static struct ethtool_ops netdev_ethtool_ops;
|
||||
static void set_rx_mode(struct net_device *dev);
|
||||
|
||||
static dev_info_t dev_info = "3c574_cs";
|
||||
|
||||
static dev_link_t *tc574_attach(void);
|
||||
static void tc574_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list;
|
||||
static void tc574_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*
|
||||
tc574_attach() creates an "instance" of the driver, allocating
|
||||
@@ -263,20 +256,18 @@ static dev_link_t *dev_list;
|
||||
with Card Services.
|
||||
*/
|
||||
|
||||
static dev_link_t *tc574_attach(void)
|
||||
static int tc574_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
struct el3_private *lp;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
struct net_device *dev;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "3c574_attach()\n");
|
||||
|
||||
/* Create the PC card device object. */
|
||||
dev = alloc_etherdev(sizeof(struct el3_private));
|
||||
if (!dev)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
lp = netdev_priv(dev);
|
||||
link = &lp->link;
|
||||
link->priv = dev;
|
||||
@@ -307,20 +298,13 @@ static dev_link_t *tc574_attach(void)
|
||||
dev->watchdog_timeo = TX_TIMEOUT;
|
||||
#endif
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
tc574_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
tc574_config(link);
|
||||
|
||||
return 0;
|
||||
} /* tc574_attach */
|
||||
|
||||
/*
|
||||
@@ -332,30 +316,19 @@ static dev_link_t *tc574_attach(void)
|
||||
|
||||
*/
|
||||
|
||||
static void tc574_detach(dev_link_t *link)
|
||||
static void tc574_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
dev_link_t **linkp;
|
||||
|
||||
DEBUG(0, "3c574_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->dev)
|
||||
unregister_netdev(dev);
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
tc574_release(link);
|
||||
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
free_netdev(dev);
|
||||
} /* tc574_detach */
|
||||
|
||||
@@ -547,56 +520,37 @@ static void tc574_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
/*
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
*/
|
||||
|
||||
static int tc574_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int tc574_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
DEBUG(1, "3c574_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
tc574_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
tc574_reset(dev);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
}
|
||||
break;
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
|
||||
return 0;
|
||||
} /* tc574_event */
|
||||
}
|
||||
|
||||
static int tc574_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
tc574_reset(dev);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void dump_status(struct net_device *dev)
|
||||
{
|
||||
@@ -1292,10 +1246,11 @@ static struct pcmcia_driver tc574_driver = {
|
||||
.drv = {
|
||||
.name = "3c574_cs",
|
||||
},
|
||||
.attach = tc574_attach,
|
||||
.event = tc574_event,
|
||||
.detach = tc574_detach,
|
||||
.probe = tc574_attach,
|
||||
.remove = tc574_detach,
|
||||
.id_table = tc574_ids,
|
||||
.suspend = tc574_suspend,
|
||||
.resume = tc574_resume,
|
||||
};
|
||||
|
||||
static int __init init_tc574(void)
|
||||
@@ -1306,7 +1261,6 @@ static int __init init_tc574(void)
|
||||
static void __exit exit_tc574(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&tc574_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_tc574);
|
||||
|
||||
@@ -143,8 +143,6 @@ DRV_NAME ".c " DRV_VERSION " 2001/10/13 00:08:50 (David Hinds)";
|
||||
|
||||
static void tc589_config(dev_link_t *link);
|
||||
static void tc589_release(dev_link_t *link);
|
||||
static int tc589_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
static u16 read_eeprom(kio_addr_t ioaddr, int index);
|
||||
static void tc589_reset(struct net_device *dev);
|
||||
@@ -161,12 +159,7 @@ static void el3_tx_timeout(struct net_device *dev);
|
||||
static void set_multicast_list(struct net_device *dev);
|
||||
static struct ethtool_ops netdev_ethtool_ops;
|
||||
|
||||
static dev_info_t dev_info = "3c589_cs";
|
||||
|
||||
static dev_link_t *tc589_attach(void);
|
||||
static void tc589_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list;
|
||||
static void tc589_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*======================================================================
|
||||
|
||||
@@ -176,20 +169,18 @@ static dev_link_t *dev_list;
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *tc589_attach(void)
|
||||
static int tc589_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
struct el3_private *lp;
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
struct net_device *dev;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "3c589_attach()\n");
|
||||
|
||||
|
||||
/* Create new ethernet device */
|
||||
dev = alloc_etherdev(sizeof(struct el3_private));
|
||||
if (!dev)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
lp = netdev_priv(dev);
|
||||
link = &lp->link;
|
||||
link->priv = dev;
|
||||
@@ -206,7 +197,7 @@ static dev_link_t *tc589_attach(void)
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
link->conf.ConfigIndex = 1;
|
||||
link->conf.Present = PRESENT_OPTION;
|
||||
|
||||
|
||||
/* The EL3-specific entries in the device structure. */
|
||||
SET_MODULE_OWNER(dev);
|
||||
dev->hard_start_xmit = &el3_start_xmit;
|
||||
@@ -221,20 +212,13 @@ static dev_link_t *tc589_attach(void)
|
||||
#endif
|
||||
SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
tc589_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
return link;
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
tc589_config(link);
|
||||
|
||||
return 0;
|
||||
} /* tc589_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -246,30 +230,19 @@ static dev_link_t *tc589_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void tc589_detach(dev_link_t *link)
|
||||
static void tc589_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
dev_link_t **linkp;
|
||||
|
||||
|
||||
DEBUG(0, "3c589_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->dev)
|
||||
unregister_netdev(dev);
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
tc589_release(link);
|
||||
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
|
||||
free_netdev(dev);
|
||||
} /* tc589_detach */
|
||||
|
||||
@@ -421,58 +394,37 @@ static void tc589_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int tc589_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int tc589_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
DEBUG(1, "3c589_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
netif_device_detach(dev);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
tc589_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
pcmcia_release_configuration(link->handle);
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tc589_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
tc589_reset(dev);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
tc589_reset(dev);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* tc589_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*====================================================================*/
|
||||
|
||||
@@ -1067,10 +1019,11 @@ static struct pcmcia_driver tc589_driver = {
|
||||
.drv = {
|
||||
.name = "3c589_cs",
|
||||
},
|
||||
.attach = tc589_attach,
|
||||
.event = tc589_event,
|
||||
.detach = tc589_detach,
|
||||
.probe = tc589_attach,
|
||||
.remove = tc589_detach,
|
||||
.id_table = tc589_ids,
|
||||
.suspend = tc589_suspend,
|
||||
.resume = tc589_resume,
|
||||
};
|
||||
|
||||
static int __init init_tc589(void)
|
||||
@@ -1081,7 +1034,6 @@ static int __init init_tc589(void)
|
||||
static void __exit exit_tc589(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&tc589_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_tc589);
|
||||
|
||||
@@ -87,8 +87,6 @@ static char *version =
|
||||
|
||||
static void axnet_config(dev_link_t *link);
|
||||
static void axnet_release(dev_link_t *link);
|
||||
static int axnet_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
static int axnet_open(struct net_device *dev);
|
||||
static int axnet_close(struct net_device *dev);
|
||||
static int axnet_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
|
||||
@@ -107,11 +105,7 @@ static void block_input(struct net_device *dev, int count,
|
||||
static void block_output(struct net_device *dev, int count,
|
||||
const u_char *buf, const int start_page);
|
||||
|
||||
static dev_link_t *axnet_attach(void);
|
||||
static void axnet_detach(dev_link_t *);
|
||||
|
||||
static dev_info_t dev_info = "axnet_cs";
|
||||
static dev_link_t *dev_list;
|
||||
static void axnet_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
static void axdev_setup(struct net_device *dev);
|
||||
static void AX88190_init(struct net_device *dev, int startp);
|
||||
@@ -147,13 +141,11 @@ static inline axnet_dev_t *PRIV(struct net_device *dev)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *axnet_attach(void)
|
||||
static int axnet_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
axnet_dev_t *info;
|
||||
dev_link_t *link;
|
||||
struct net_device *dev;
|
||||
client_reg_t client_reg;
|
||||
int ret;
|
||||
|
||||
DEBUG(0, "axnet_attach()\n");
|
||||
|
||||
@@ -161,7 +153,7 @@ static dev_link_t *axnet_attach(void)
|
||||
"eth%d", axdev_setup);
|
||||
|
||||
if (!dev)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
info = PRIV(dev);
|
||||
link = &info->link;
|
||||
@@ -176,20 +168,13 @@ static dev_link_t *axnet_attach(void)
|
||||
dev->do_ioctl = &axnet_ioctl;
|
||||
SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != CS_SUCCESS) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
axnet_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->handle = p_dev;
|
||||
p_dev->instance = link;
|
||||
|
||||
return link;
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
axnet_config(link);
|
||||
|
||||
return 0;
|
||||
} /* axnet_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -201,30 +186,19 @@ static dev_link_t *axnet_attach(void)
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void axnet_detach(dev_link_t *link)
|
||||
static void axnet_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
dev_link_t **linkp;
|
||||
|
||||
DEBUG(0, "axnet_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
if (link->dev)
|
||||
unregister_netdev(dev);
|
||||
|
||||
if (link->state & DEV_CONFIG)
|
||||
axnet_release(link);
|
||||
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
*linkp = link->next;
|
||||
free_netdev(dev);
|
||||
} /* axnet_detach */
|
||||
|
||||
@@ -490,59 +464,39 @@ static void axnet_release(dev_link_t *link)
|
||||
link->state &= ~DEV_CONFIG;
|
||||
}
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int axnet_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int axnet_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
struct net_device *dev = link->priv;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
DEBUG(2, "axnet_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
netif_device_detach(dev);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
|
||||
axnet_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
pcmcia_release_configuration(link->handle);
|
||||
if (link->open)
|
||||
netif_device_detach(dev);
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int axnet_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct net_device *dev = link->priv;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
if (link->state & DEV_CONFIG) {
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
axnet_reset_8390(dev);
|
||||
AX88190_init(dev, 1);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
axnet_reset_8390(dev);
|
||||
AX88190_init(dev, 1);
|
||||
netif_device_attach(dev);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* axnet_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*======================================================================
|
||||
|
||||
@@ -616,7 +570,7 @@ static int axnet_open(struct net_device *dev)
|
||||
|
||||
link->open++;
|
||||
|
||||
request_irq(dev->irq, ei_irq_wrapper, SA_SHIRQ, dev_info, dev);
|
||||
request_irq(dev->irq, ei_irq_wrapper, SA_SHIRQ, "axnet_cs", dev);
|
||||
|
||||
info->link_status = 0x00;
|
||||
init_timer(&info->watchdog);
|
||||
@@ -877,10 +831,11 @@ static struct pcmcia_driver axnet_cs_driver = {
|
||||
.drv = {
|
||||
.name = "axnet_cs",
|
||||
},
|
||||
.attach = axnet_attach,
|
||||
.event = axnet_event,
|
||||
.detach = axnet_detach,
|
||||
.probe = axnet_attach,
|
||||
.remove = axnet_detach,
|
||||
.id_table = axnet_ids,
|
||||
.suspend = axnet_suspend,
|
||||
.resume = axnet_resume,
|
||||
};
|
||||
|
||||
static int __init init_axnet_cs(void)
|
||||
@@ -891,7 +846,6 @@ static int __init init_axnet_cs(void)
|
||||
static void __exit exit_axnet_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&axnet_cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_axnet_cs);
|
||||
|
||||
@@ -120,15 +120,8 @@ MODULE_LICENSE("GPL");
|
||||
|
||||
static void com20020_config(dev_link_t *link);
|
||||
static void com20020_release(dev_link_t *link);
|
||||
static int com20020_event(event_t event, int priority,
|
||||
event_callback_args_t *args);
|
||||
|
||||
static dev_info_t dev_info = "com20020_cs";
|
||||
|
||||
static dev_link_t *com20020_attach(void);
|
||||
static void com20020_detach(dev_link_t *);
|
||||
|
||||
static dev_link_t *dev_list;
|
||||
static void com20020_detach(struct pcmcia_device *p_dev);
|
||||
|
||||
/*====================================================================*/
|
||||
|
||||
@@ -145,21 +138,19 @@ typedef struct com20020_dev_t {
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static dev_link_t *com20020_attach(void)
|
||||
static int com20020_attach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
client_reg_t client_reg;
|
||||
dev_link_t *link;
|
||||
com20020_dev_t *info;
|
||||
struct net_device *dev;
|
||||
int ret;
|
||||
struct arcnet_local *lp;
|
||||
|
||||
|
||||
DEBUG(0, "com20020_attach()\n");
|
||||
|
||||
/* Create new network device */
|
||||
link = kmalloc(sizeof(struct dev_link_t), GFP_KERNEL);
|
||||
if (!link)
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
|
||||
info = kmalloc(sizeof(struct com20020_dev_t), GFP_KERNEL);
|
||||
if (!info)
|
||||
@@ -191,30 +182,19 @@ static dev_link_t *com20020_attach(void)
|
||||
link->conf.IntType = INT_MEMORY_AND_IO;
|
||||
link->conf.Present = PRESENT_OPTION;
|
||||
|
||||
|
||||
link->irq.Instance = info->dev = dev;
|
||||
link->priv = info;
|
||||
|
||||
/* Register with Card Services */
|
||||
link->next = dev_list;
|
||||
dev_list = link;
|
||||
client_reg.dev_info = &dev_info;
|
||||
client_reg.Version = 0x0210;
|
||||
client_reg.event_callback_args.client_data = link;
|
||||
ret = pcmcia_register_client(&link->handle, &client_reg);
|
||||
if (ret != 0) {
|
||||
cs_error(link->handle, RegisterClient, ret);
|
||||
com20020_detach(link);
|
||||
return NULL;
|
||||
}
|
||||
link->state |= DEV_PRESENT;
|
||||
com20020_config(link);
|
||||
|
||||
return link;
|
||||
return 0;
|
||||
|
||||
fail_alloc_dev:
|
||||
kfree(info);
|
||||
fail_alloc_info:
|
||||
kfree(link);
|
||||
return NULL;
|
||||
return -ENOMEM;
|
||||
} /* com20020_attach */
|
||||
|
||||
/*======================================================================
|
||||
@@ -226,29 +206,21 @@ fail_alloc_info:
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static void com20020_detach(dev_link_t *link)
|
||||
static void com20020_detach(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
struct com20020_dev_t *info = link->priv;
|
||||
dev_link_t **linkp;
|
||||
struct net_device *dev;
|
||||
|
||||
struct net_device *dev = info->dev;
|
||||
|
||||
DEBUG(1,"detach...\n");
|
||||
|
||||
DEBUG(0, "com20020_detach(0x%p)\n", link);
|
||||
|
||||
/* Locate device structure */
|
||||
for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next)
|
||||
if (*linkp == link) break;
|
||||
if (*linkp == NULL)
|
||||
return;
|
||||
|
||||
dev = info->dev;
|
||||
|
||||
if (link->dev) {
|
||||
DEBUG(1,"unregister...\n");
|
||||
|
||||
unregister_netdev(dev);
|
||||
|
||||
|
||||
/*
|
||||
* this is necessary because we register our IRQ separately
|
||||
* from card services.
|
||||
@@ -260,12 +232,8 @@ static void com20020_detach(dev_link_t *link)
|
||||
if (link->state & DEV_CONFIG)
|
||||
com20020_release(link);
|
||||
|
||||
if (link->handle)
|
||||
pcmcia_deregister_client(link->handle);
|
||||
|
||||
/* Unlink device structure, free bits */
|
||||
DEBUG(1,"unlinking...\n");
|
||||
*linkp = link->next;
|
||||
if (link->priv)
|
||||
{
|
||||
dev = info->dev;
|
||||
@@ -421,61 +389,41 @@ static void com20020_release(dev_link_t *link)
|
||||
link->state &= ~(DEV_CONFIG | DEV_RELEASE_PENDING);
|
||||
}
|
||||
|
||||
/*======================================================================
|
||||
|
||||
The card status event handler. Mostly, this schedules other
|
||||
stuff to run after an event is received. A CARD_REMOVAL event
|
||||
also sets some flags to discourage the net drivers from trying
|
||||
to talk to the card any more.
|
||||
|
||||
======================================================================*/
|
||||
|
||||
static int com20020_event(event_t event, int priority,
|
||||
event_callback_args_t *args)
|
||||
static int com20020_suspend(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = args->client_data;
|
||||
com20020_dev_t *info = link->priv;
|
||||
struct net_device *dev = info->dev;
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
com20020_dev_t *info = link->priv;
|
||||
struct net_device *dev = info->dev;
|
||||
|
||||
DEBUG(1, "com20020_event(0x%06x)\n", event);
|
||||
|
||||
switch (event) {
|
||||
case CS_EVENT_CARD_REMOVAL:
|
||||
link->state &= ~DEV_PRESENT;
|
||||
if (link->state & DEV_CONFIG)
|
||||
netif_device_detach(dev);
|
||||
break;
|
||||
case CS_EVENT_CARD_INSERTION:
|
||||
link->state |= DEV_PRESENT;
|
||||
com20020_config(link);
|
||||
break;
|
||||
case CS_EVENT_PM_SUSPEND:
|
||||
link->state |= DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_RESET_PHYSICAL:
|
||||
link->state |= DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
if (link->open) {
|
||||
netif_device_detach(dev);
|
||||
}
|
||||
pcmcia_release_configuration(link->handle);
|
||||
if (link->open) {
|
||||
netif_device_detach(dev);
|
||||
}
|
||||
pcmcia_release_configuration(link->handle);
|
||||
}
|
||||
break;
|
||||
case CS_EVENT_PM_RESUME:
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
/* Fall through... */
|
||||
case CS_EVENT_CARD_RESET:
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int com20020_resume(struct pcmcia_device *p_dev)
|
||||
{
|
||||
dev_link_t *link = dev_to_instance(p_dev);
|
||||
com20020_dev_t *info = link->priv;
|
||||
struct net_device *dev = info->dev;
|
||||
|
||||
link->state &= ~DEV_SUSPEND;
|
||||
if (link->state & DEV_CONFIG) {
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
int ioaddr = dev->base_addr;
|
||||
struct arcnet_local *lp = dev->priv;
|
||||
ARCRESET;
|
||||
}
|
||||
pcmcia_request_configuration(link->handle, &link->conf);
|
||||
if (link->open) {
|
||||
int ioaddr = dev->base_addr;
|
||||
struct arcnet_local *lp = dev->priv;
|
||||
ARCRESET;
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
} /* com20020_event */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct pcmcia_device_id com20020_ids[] = {
|
||||
PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.", "PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),
|
||||
@@ -488,10 +436,11 @@ static struct pcmcia_driver com20020_cs_driver = {
|
||||
.drv = {
|
||||
.name = "com20020_cs",
|
||||
},
|
||||
.attach = com20020_attach,
|
||||
.event = com20020_event,
|
||||
.detach = com20020_detach,
|
||||
.probe = com20020_attach,
|
||||
.remove = com20020_detach,
|
||||
.id_table = com20020_ids,
|
||||
.suspend = com20020_suspend,
|
||||
.resume = com20020_resume,
|
||||
};
|
||||
|
||||
static int __init init_com20020_cs(void)
|
||||
@@ -502,7 +451,6 @@ static int __init init_com20020_cs(void)
|
||||
static void __exit exit_com20020_cs(void)
|
||||
{
|
||||
pcmcia_unregister_driver(&com20020_cs_driver);
|
||||
BUG_ON(dev_list != NULL);
|
||||
}
|
||||
|
||||
module_init(init_com20020_cs);
|
||||
|
||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user