^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * card.c - contains functions for managing groups of PnP devices
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/ctype.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/pnp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/dma-mapping.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "base.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) LIST_HEAD(pnp_cards);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) static LIST_HEAD(pnp_card_drivers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static const struct pnp_card_device_id *match_card(struct pnp_card_driver *drv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) struct pnp_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) const struct pnp_card_device_id *drv_id = drv->id_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) while (*drv_id->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) if (compare_pnp_id(card->id, drv_id->id)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) int found;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) struct pnp_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) if (i == PNP_MAX_DEVICES ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) !*drv_id->devs[i].id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) return drv_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) found = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) card_for_each_dev(card, dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) if (compare_pnp_id(dev->id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) drv_id->devs[i].id)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) found = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) if (!found)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) drv_id++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) static void card_remove(struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) dev->card_link = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static void card_remove_first(struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct pnp_card_driver *drv = to_pnp_card_driver(dev->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) if (!dev->card || !drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) if (drv->remove)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) drv->remove(dev->card_link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) drv->link.remove = &card_remove;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) kfree(dev->card_link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) card_remove(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) static int card_probe(struct pnp_card *card, struct pnp_card_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) const struct pnp_card_device_id *id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct pnp_card_link *clink;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct pnp_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) if (!drv->probe)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) id = match_card(drv, card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) if (!id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) clink = pnp_alloc(sizeof(*clink));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if (!clink)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) clink->card = card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) clink->driver = drv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) clink->pm_state = PMSG_ON;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (drv->probe(clink, id) >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) /* Recovery */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) card_for_each_dev(card, dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) if (dev->card_link == clink)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) pnp_release_card_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) kfree(clink);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) * pnp_add_card_id - adds an EISA id to the specified card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) * @id: pointer to a pnp_id structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) * @card: pointer to the desired card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) static struct pnp_id *pnp_add_card_id(struct pnp_card *card, char *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) struct pnp_id *dev_id, *ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) if (!dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) dev_id->id[0] = id[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) dev_id->id[1] = id[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) dev_id->id[2] = id[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) dev_id->id[3] = tolower(id[3]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) dev_id->id[4] = tolower(id[4]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) dev_id->id[5] = tolower(id[5]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) dev_id->id[6] = tolower(id[6]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) dev_id->id[7] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) dev_id->next = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) ptr = card->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) while (ptr && ptr->next)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) ptr = ptr->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) if (ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) ptr->next = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) card->id = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) return dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static void pnp_free_card_ids(struct pnp_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) struct pnp_id *id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) struct pnp_id *next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) id = card->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) while (id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) next = id->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) kfree(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) id = next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) static void pnp_release_card(struct device *dmdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) struct pnp_card *card = to_pnp_card(dmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) pnp_free_card_ids(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) kfree(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) struct pnp_card *pnp_alloc_card(struct pnp_protocol *protocol, int id, char *pnpid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) struct pnp_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) struct pnp_id *dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) card = kzalloc(sizeof(struct pnp_card), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) if (!card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) card->protocol = protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) card->number = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) card->dev.parent = &card->protocol->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) dev_set_name(&card->dev, "%02x:%02x", card->protocol->number, card->number);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) card->dev.coherent_dma_mask = DMA_BIT_MASK(24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) card->dev.dma_mask = &card->dev.coherent_dma_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) dev_id = pnp_add_card_id(card, pnpid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (!dev_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) kfree(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) return card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) static ssize_t pnp_show_card_name(struct device *dmdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) char *str = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) struct pnp_card *card = to_pnp_card(dmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) str += sprintf(str, "%s\n", card->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) return (str - buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) static DEVICE_ATTR(name, S_IRUGO, pnp_show_card_name, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) static ssize_t pnp_show_card_ids(struct device *dmdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) char *str = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) struct pnp_card *card = to_pnp_card(dmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) struct pnp_id *pos = card->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) while (pos) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) str += sprintf(str, "%s\n", pos->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) pos = pos->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return (str - buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) static DEVICE_ATTR(card_id, S_IRUGO, pnp_show_card_ids, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) static int pnp_interface_attach_card(struct pnp_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) int rc = device_create_file(&card->dev, &dev_attr_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) rc = device_create_file(&card->dev, &dev_attr_card_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) goto err_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) err_name:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) device_remove_file(&card->dev, &dev_attr_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) * pnp_add_card - adds a PnP card to the PnP Layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) * @card: pointer to the card to add
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) int pnp_add_card(struct pnp_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) struct list_head *pos, *temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) card->dev.bus = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) card->dev.release = &pnp_release_card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) error = device_register(&card->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) dev_err(&card->dev, "could not register (err=%d)\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) put_device(&card->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) pnp_interface_attach_card(card);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) list_add_tail(&card->global_list, &pnp_cards);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) list_add_tail(&card->protocol_list, &card->protocol->cards);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) /* we wait until now to add devices in order to ensure the drivers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) * will be able to use all of the related devices on the card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) * without waiting an unreasonable length of time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) list_for_each(pos, &card->devices) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) struct pnp_dev *dev = card_to_pnp_dev(pos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) __pnp_add_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) /* match with card drivers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) list_for_each_safe(pos, temp, &pnp_card_drivers) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) struct pnp_card_driver *drv =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) list_entry(pos, struct pnp_card_driver,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) global_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) card_probe(card, drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) * pnp_remove_card - removes a PnP card from the PnP Layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) * @card: pointer to the card to remove
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) void pnp_remove_card(struct pnp_card *card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) struct list_head *pos, *temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) device_unregister(&card->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) list_del(&card->global_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) list_del(&card->protocol_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) list_for_each_safe(pos, temp, &card->devices) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) struct pnp_dev *dev = card_to_pnp_dev(pos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) pnp_remove_card_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) * pnp_add_card_device - adds a device to the specified card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) * @card: pointer to the card to add to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) * @dev: pointer to the device to add
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) int pnp_add_card_device(struct pnp_card *card, struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) dev->dev.parent = &card->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) dev->card_link = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) dev_set_name(&dev->dev, "%02x:%02x.%02x",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) dev->protocol->number, card->number, dev->number);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) dev->card = card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) list_add_tail(&dev->card_list, &card->devices);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) * pnp_remove_card_device- removes a device from the specified card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) * @dev: pointer to the device to remove
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) void pnp_remove_card_device(struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) dev->card = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) list_del(&dev->card_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) __pnp_remove_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) * pnp_request_card_device - Searches for a PnP device under the specified card
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) * @clink: pointer to the card link, cannot be NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) * @id: pointer to a PnP ID structure that explains the rules for finding the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) * @from: Starting place to search from. If NULL it will start from the beginning.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) struct pnp_dev *pnp_request_card_device(struct pnp_card_link *clink,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) const char *id, struct pnp_dev *from)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) struct list_head *pos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) struct pnp_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) struct pnp_card_driver *drv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) struct pnp_card *card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) if (!clink || !id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) card = clink->card;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) drv = clink->driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (!from) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) pos = card->devices.next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (from->card != card)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) pos = from->card_list.next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) while (pos != &card->devices) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) dev = card_to_pnp_dev(pos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) if ((!dev->card_link) && compare_pnp_id(dev->id, id))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) goto found;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) pos = pos->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) found:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) dev->card_link = clink;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) dev->dev.driver = &drv->link.driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) if (pnp_bus_type.probe(&dev->dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (device_bind_driver(&dev->dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) return dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) err_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) dev->dev.driver = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) dev->card_link = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) * pnp_release_card_device - call this when the driver no longer needs the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * @dev: pointer to the PnP device structure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) void pnp_release_card_device(struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) struct pnp_card_driver *drv = dev->card_link->driver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) drv->link.remove = &card_remove;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) device_release_driver(&dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) drv->link.remove = &card_remove_first;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) * suspend/resume callbacks
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) static int card_suspend(struct pnp_dev *dev, pm_message_t state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) struct pnp_card_link *link = dev->card_link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (link->pm_state.event == state.event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) link->pm_state = state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) return link->driver->suspend(link, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) static int card_resume(struct pnp_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) struct pnp_card_link *link = dev->card_link;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) if (link->pm_state.event == PM_EVENT_ON)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) link->pm_state = PMSG_ON;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) link->driver->resume(link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) * pnp_register_card_driver - registers a PnP card driver with the PnP Layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) * @drv: pointer to the driver to register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) int pnp_register_card_driver(struct pnp_card_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) struct list_head *pos, *temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) drv->link.name = drv->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) drv->link.id_table = NULL; /* this will disable auto matching */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) drv->link.flags = drv->flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) drv->link.probe = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) drv->link.remove = &card_remove_first;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) drv->link.suspend = drv->suspend ? card_suspend : NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) drv->link.resume = drv->resume ? card_resume : NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) error = pnp_register_driver(&drv->link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) if (error < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) list_add_tail(&drv->global_list, &pnp_card_drivers);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) list_for_each_safe(pos, temp, &pnp_cards) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) struct pnp_card *card =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) list_entry(pos, struct pnp_card, global_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) card_probe(card, drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) * pnp_unregister_card_driver - unregisters a PnP card driver from the PnP Layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) * @drv: pointer to the driver to unregister
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) void pnp_unregister_card_driver(struct pnp_card_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) mutex_lock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) list_del(&drv->global_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) mutex_unlock(&pnp_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) pnp_unregister_driver(&drv->link);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) EXPORT_SYMBOL(pnp_request_card_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) EXPORT_SYMBOL(pnp_release_card_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) EXPORT_SYMBOL(pnp_register_card_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) EXPORT_SYMBOL(pnp_unregister_card_driver);