Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
core.c
Go to the documentation of this file.
1 /*
2  * cb710/core.c
3  *
4  * Copyright by Michał Mirosław, 2008-2009
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/pci.h>
13 #include <linux/spinlock.h>
14 #include <linux/idr.h>
15 #include <linux/cb710.h>
16 #include <linux/gfp.h>
17 
18 static DEFINE_IDA(cb710_ida);
19 static DEFINE_SPINLOCK(cb710_ida_lock);
20 
23 {
24  u32 rval;
25 
26  pci_read_config_dword(pdev, reg, &rval);
27  rval = (rval & mask) ^ xor;
28  pci_write_config_dword(pdev, reg, rval);
29 }
31 
32 /* Some magic writes based on Windows driver init code */
33 static int __devinit cb710_pci_configure(struct pci_dev *pdev)
34 {
35  unsigned int devfn = PCI_DEVFN(PCI_SLOT(pdev->devfn), 0);
36  struct pci_dev *pdev0;
37  u32 val;
38 
39  cb710_pci_update_config_reg(pdev, 0x48,
40  ~0x000000FF, 0x0000003F);
41 
42  pci_read_config_dword(pdev, 0x48, &val);
43  if (val & 0x80000000)
44  return 0;
45 
46  pdev0 = pci_get_slot(pdev->bus, devfn);
47  if (!pdev0)
48  return -ENODEV;
49 
50  if (pdev0->vendor == PCI_VENDOR_ID_ENE
51  && pdev0->device == PCI_DEVICE_ID_ENE_720) {
52  cb710_pci_update_config_reg(pdev0, 0x8C,
53  ~0x00F00000, 0x00100000);
54  cb710_pci_update_config_reg(pdev0, 0xB0,
55  ~0x08000000, 0x08000000);
56  }
57 
58  cb710_pci_update_config_reg(pdev0, 0x8C,
59  ~0x00000F00, 0x00000200);
60  cb710_pci_update_config_reg(pdev0, 0x90,
61  ~0x00060000, 0x00040000);
62 
63  pci_dev_put(pdev0);
64 
65  return 0;
66 }
67 
68 static irqreturn_t cb710_irq_handler(int irq, void *data)
69 {
70  struct cb710_chip *chip = data;
71  struct cb710_slot *slot = &chip->slot[0];
72  irqreturn_t handled = IRQ_NONE;
73  unsigned nr;
74 
75  spin_lock(&chip->irq_lock); /* incl. smp_rmb() */
76 
77  for (nr = chip->slots; nr; ++slot, --nr) {
78  cb710_irq_handler_t handler_func = slot->irq_handler;
79  if (handler_func && handler_func(slot))
80  handled = IRQ_HANDLED;
81  }
82 
83  spin_unlock(&chip->irq_lock);
84 
85  return handled;
86 }
87 
88 static void cb710_release_slot(struct device *dev)
89 {
90 #ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
91  struct cb710_slot *slot = cb710_pdev_to_slot(to_platform_device(dev));
92  struct cb710_chip *chip = cb710_slot_to_chip(slot);
93 
94  /* slot struct can be freed now */
95  atomic_dec(&chip->slot_refs_count);
96 #endif
97 }
98 
99 static int __devinit cb710_register_slot(struct cb710_chip *chip,
100  unsigned slot_mask, unsigned io_offset, const char *name)
101 {
102  int nr = chip->slots;
103  struct cb710_slot *slot = &chip->slot[nr];
104  int err;
105 
106  dev_dbg(cb710_chip_dev(chip),
107  "register: %s.%d; slot %d; mask %d; IO offset: 0x%02X\n",
108  name, chip->platform_id, nr, slot_mask, io_offset);
109 
110  /* slot->irq_handler == NULL here; this needs to be
111  * seen before platform_device_register() */
112  ++chip->slots;
113  smp_wmb();
114 
115  slot->iobase = chip->iobase + io_offset;
116  slot->pdev.name = name;
117  slot->pdev.id = chip->platform_id;
118  slot->pdev.dev.parent = &chip->pdev->dev;
119  slot->pdev.dev.release = cb710_release_slot;
120 
121  err = platform_device_register(&slot->pdev);
122 
123 #ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
124  atomic_inc(&chip->slot_refs_count);
125 #endif
126 
127  if (err) {
128  /* device_initialize() called from platform_device_register()
129  * wants this on error path */
130  platform_device_put(&slot->pdev);
131 
132  /* slot->irq_handler == NULL here anyway, so no lock needed */
133  --chip->slots;
134  return err;
135  }
136 
137  chip->slot_mask |= slot_mask;
138 
139  return 0;
140 }
141 
142 static void cb710_unregister_slot(struct cb710_chip *chip,
143  unsigned slot_mask)
144 {
145  int nr = chip->slots - 1;
146 
147  if (!(chip->slot_mask & slot_mask))
148  return;
149 
150  platform_device_unregister(&chip->slot[nr].pdev);
151 
152  /* complementary to spin_unlock() in cb710_set_irq_handler() */
153  smp_rmb();
154  BUG_ON(chip->slot[nr].irq_handler != NULL);
155 
156  /* slot->irq_handler == NULL here, so no lock needed */
157  --chip->slots;
158  chip->slot_mask &= ~slot_mask;
159 }
160 
162  cb710_irq_handler_t handler)
163 {
164  struct cb710_chip *chip = cb710_slot_to_chip(slot);
165  unsigned long flags;
166 
167  spin_lock_irqsave(&chip->irq_lock, flags);
168  slot->irq_handler = handler;
169  spin_unlock_irqrestore(&chip->irq_lock, flags);
170 }
172 
173 #ifdef CONFIG_PM
174 
175 static int cb710_suspend(struct pci_dev *pdev, pm_message_t state)
176 {
177  struct cb710_chip *chip = pci_get_drvdata(pdev);
178 
179  free_irq(pdev->irq, chip);
180  pci_save_state(pdev);
181  pci_disable_device(pdev);
182  if (state.event & PM_EVENT_SLEEP)
184  return 0;
185 }
186 
187 static int cb710_resume(struct pci_dev *pdev)
188 {
189  struct cb710_chip *chip = pci_get_drvdata(pdev);
190  int err;
191 
193  pci_restore_state(pdev);
194  err = pcim_enable_device(pdev);
195  if (err)
196  return err;
197 
198  return devm_request_irq(&pdev->dev, pdev->irq,
199  cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
200 }
201 
202 #endif /* CONFIG_PM */
203 
204 static int __devinit cb710_probe(struct pci_dev *pdev,
205  const struct pci_device_id *ent)
206 {
207  struct cb710_chip *chip;
208  unsigned long flags;
209  u32 val;
210  int err;
211  int n = 0;
212 
213  err = cb710_pci_configure(pdev);
214  if (err)
215  return err;
216 
217  /* this is actually magic... */
218  pci_read_config_dword(pdev, 0x48, &val);
219  if (!(val & 0x80000000)) {
220  pci_write_config_dword(pdev, 0x48, val|0x71000000);
221  pci_read_config_dword(pdev, 0x48, &val);
222  }
223 
224  dev_dbg(&pdev->dev, "PCI config[0x48] = 0x%08X\n", val);
225  if (!(val & 0x70000000))
226  return -ENODEV;
227  val = (val >> 28) & 7;
228  if (val & CB710_SLOT_MMC)
229  ++n;
230  if (val & CB710_SLOT_MS)
231  ++n;
232  if (val & CB710_SLOT_SM)
233  ++n;
234 
235  chip = devm_kzalloc(&pdev->dev,
236  sizeof(*chip) + n * sizeof(*chip->slot), GFP_KERNEL);
237  if (!chip)
238  return -ENOMEM;
239 
240  err = pcim_enable_device(pdev);
241  if (err)
242  return err;
243 
244  err = pcim_iomap_regions(pdev, 0x0001, KBUILD_MODNAME);
245  if (err)
246  return err;
247 
248  spin_lock_init(&chip->irq_lock);
249  chip->pdev = pdev;
250  chip->iobase = pcim_iomap_table(pdev)[0];
251 
252  pci_set_drvdata(pdev, chip);
253 
254  err = devm_request_irq(&pdev->dev, pdev->irq,
255  cb710_irq_handler, IRQF_SHARED, KBUILD_MODNAME, chip);
256  if (err)
257  return err;
258 
259  do {
260  if (!ida_pre_get(&cb710_ida, GFP_KERNEL))
261  return -ENOMEM;
262 
263  spin_lock_irqsave(&cb710_ida_lock, flags);
264  err = ida_get_new(&cb710_ida, &chip->platform_id);
265  spin_unlock_irqrestore(&cb710_ida_lock, flags);
266 
267  if (err && err != -EAGAIN)
268  return err;
269  } while (err);
270 
271 
272  dev_info(&pdev->dev, "id %d, IO 0x%p, IRQ %d\n",
273  chip->platform_id, chip->iobase, pdev->irq);
274 
275  if (val & CB710_SLOT_MMC) { /* MMC/SD slot */
276  err = cb710_register_slot(chip,
277  CB710_SLOT_MMC, 0x00, "cb710-mmc");
278  if (err)
279  return err;
280  }
281 
282  if (val & CB710_SLOT_MS) { /* MemoryStick slot */
283  err = cb710_register_slot(chip,
284  CB710_SLOT_MS, 0x40, "cb710-ms");
285  if (err)
286  goto unreg_mmc;
287  }
288 
289  if (val & CB710_SLOT_SM) { /* SmartMedia slot */
290  err = cb710_register_slot(chip,
291  CB710_SLOT_SM, 0x60, "cb710-sm");
292  if (err)
293  goto unreg_ms;
294  }
295 
296  return 0;
297 unreg_ms:
298  cb710_unregister_slot(chip, CB710_SLOT_MS);
299 unreg_mmc:
300  cb710_unregister_slot(chip, CB710_SLOT_MMC);
301 
302 #ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
303  BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
304 #endif
305  return err;
306 }
307 
308 static void __devexit cb710_remove_one(struct pci_dev *pdev)
309 {
310  struct cb710_chip *chip = pci_get_drvdata(pdev);
311  unsigned long flags;
312 
313  cb710_unregister_slot(chip, CB710_SLOT_SM);
314  cb710_unregister_slot(chip, CB710_SLOT_MS);
315  cb710_unregister_slot(chip, CB710_SLOT_MMC);
316 #ifdef CONFIG_CB710_DEBUG_ASSUMPTIONS
317  BUG_ON(atomic_read(&chip->slot_refs_count) != 0);
318 #endif
319 
320  spin_lock_irqsave(&cb710_ida_lock, flags);
321  ida_remove(&cb710_ida, chip->platform_id);
322  spin_unlock_irqrestore(&cb710_ida_lock, flags);
323 }
324 
325 static const struct pci_device_id cb710_pci_tbl[] = {
328  { 0, }
329 };
330 
331 static struct pci_driver cb710_driver = {
332  .name = KBUILD_MODNAME,
333  .id_table = cb710_pci_tbl,
334  .probe = cb710_probe,
335  .remove = __devexit_p(cb710_remove_one),
336 #ifdef CONFIG_PM
337  .suspend = cb710_suspend,
338  .resume = cb710_resume,
339 #endif
340 };
341 
342 static int __init cb710_init_module(void)
343 {
344  return pci_register_driver(&cb710_driver);
345 }
346 
347 static void __exit cb710_cleanup_module(void)
348 {
349  pci_unregister_driver(&cb710_driver);
350  ida_destroy(&cb710_ida);
351 }
352 
353 module_init(cb710_init_module);
354 module_exit(cb710_cleanup_module);
355 
356 MODULE_AUTHOR("Michał Mirosław <[email protected]>");
357 MODULE_DESCRIPTION("ENE CB710 memory card reader driver");
358 MODULE_LICENSE("GPL");
359 MODULE_DEVICE_TABLE(pci, cb710_pci_tbl);