Eric Lee / smarc-fsl-linux-kernel

Blame view

drivers/base/isa.c 3.68 KB
edit raw normal view history
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
1
2
3
4
5
6
7
8
9
 
  /*
   * ISA bus.
   */
  
  #include <linux/device.h>
  #include <linux/kernel.h>
  #include <linux/slab.h>
  #include <linux/module.h>
  #include <linux/init.h>
00412be1d   Rene Herman   isa: set 24-bit d... 
10
 
  #include <linux/dma-mapping.h>
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
11
12
13
 
  #include <linux/isa.h>
  
  static struct device isa_bus = {
1e0b2cf93   Kay Sievers   driver core: stru... 
14
 
  	.init_name	= "isa"
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
 
  };
  
  struct isa_dev {
  	struct device dev;
  	struct device *next;
  	unsigned int id;
  };
  
  #define to_isa_dev(x) container_of((x), struct isa_dev, dev)
  
  static int isa_bus_match(struct device *dev, struct device_driver *driver)
  {
  	struct isa_driver *isa_driver = to_isa_driver(driver);
  
  	if (dev->platform_data == isa_driver) {
  		if (!isa_driver->match ||
  			isa_driver->match(dev, to_isa_dev(dev)->id))
  			return 1;
  		dev->platform_data = NULL;
  	}
  	return 0;
  }
  
  static int isa_bus_probe(struct device *dev)
  {
  	struct isa_driver *isa_driver = dev->platform_data;
  
  	if (isa_driver->probe)
  		return isa_driver->probe(dev, to_isa_dev(dev)->id);
  
  	return 0;
  }
  
  static int isa_bus_remove(struct device *dev)
  {
  	struct isa_driver *isa_driver = dev->platform_data;
  
  	if (isa_driver->remove)
  		return isa_driver->remove(dev, to_isa_dev(dev)->id);
  
  	return 0;
  }
  
  static void isa_bus_shutdown(struct device *dev)
  {
  	struct isa_driver *isa_driver = dev->platform_data;
  
  	if (isa_driver->shutdown)
  		isa_driver->shutdown(dev, to_isa_dev(dev)->id);
  }
  
  static int isa_bus_suspend(struct device *dev, pm_message_t state)
  {
  	struct isa_driver *isa_driver = dev->platform_data;
  
  	if (isa_driver->suspend)
  		return isa_driver->suspend(dev, to_isa_dev(dev)->id, state);
  
  	return 0;
  }
  
  static int isa_bus_resume(struct device *dev)
  {
  	struct isa_driver *isa_driver = dev->platform_data;
  
  	if (isa_driver->resume)
  		return isa_driver->resume(dev, to_isa_dev(dev)->id);
  
  	return 0;
  }
  
  static struct bus_type isa_bus_type = {
  	.name		= "isa",
  	.match		= isa_bus_match,
  	.probe		= isa_bus_probe,
  	.remove		= isa_bus_remove,
  	.shutdown	= isa_bus_shutdown,
  	.suspend	= isa_bus_suspend,
  	.resume		= isa_bus_resume
  };
  
  static void isa_dev_release(struct device *dev)
  {
  	kfree(to_isa_dev(dev));
  }
  
  void isa_unregister_driver(struct isa_driver *isa_driver)
  {
  	struct device *dev = isa_driver->devices;
  
  	while (dev) {
  		struct device *tmp = to_isa_dev(dev)->next;
  		device_unregister(dev);
  		dev = tmp;
  	}
  	driver_unregister(&isa_driver->driver);
  }
  EXPORT_SYMBOL_GPL(isa_unregister_driver);
  
  int isa_register_driver(struct isa_driver *isa_driver, unsigned int ndev)
  {
  	int error;
  	unsigned int id;
  
  	isa_driver->driver.bus	= &isa_bus_type;
  	isa_driver->devices	= NULL;
  
  	error = driver_register(&isa_driver->driver);
  	if (error)
  		return error;
  
  	for (id = 0; id < ndev; id++) {
  		struct isa_dev *isa_dev;
  
  		isa_dev = kzalloc(sizeof *isa_dev, GFP_KERNEL);
  		if (!isa_dev) {
  			error = -ENOMEM;
  			break;
  		}
  
  		isa_dev->dev.parent	= &isa_bus;
  		isa_dev->dev.bus	= &isa_bus_type;
1e0b2cf93   Kay Sievers   driver core: stru... 
137
138
 
  		dev_set_name(&isa_dev->dev, "%s.%u",
  			     isa_driver->driver.name, id);
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
139
140
141
 
  		isa_dev->dev.platform_data	= isa_driver;
  		isa_dev->dev.release		= isa_dev_release;
  		isa_dev->id			= id;
2f4f27d42   Yang Hongyang   dma-mapping: repl... 
142
 
  		isa_dev->dev.coherent_dma_mask = DMA_BIT_MASK(24);
00412be1d   Rene Herman   isa: set 24-bit d... 
143
 
  		isa_dev->dev.dma_mask = &isa_dev->dev.coherent_dma_mask;
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
 
  		error = device_register(&isa_dev->dev);
  		if (error) {
  			put_device(&isa_dev->dev);
  			break;
  		}
  
  		if (isa_dev->dev.platform_data) {
  			isa_dev->next = isa_driver->devices;
  			isa_driver->devices = &isa_dev->dev;
  		} else
  			device_unregister(&isa_dev->dev);
  	}
  
  	if (!error && !isa_driver->devices)
  		error = -ENODEV;
  
  	if (error)
  		isa_unregister_driver(isa_driver);
  
  	return error;
  }
  EXPORT_SYMBOL_GPL(isa_register_driver);
  
  static int __init isa_bus_init(void)
  {
  	int error;
  
  	error = bus_register(&isa_bus_type);
  	if (!error) {
  		error = device_register(&isa_bus);
  		if (error)
  			bus_unregister(&isa_bus_type);
  	}
  	return error;
  }
  
  device_initcall(isa_bus_init);