Eric Lee / smarc-fsl-linux-kernel

Blame view

drivers/base/isa.c 3.79 KB
edit raw normal view history
989d42e85   Greg Kroah-Hartman   driver core: add ... 
1
 
  // SPDX-License-Identifier: GPL-2.0
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
2
3
4
5
6
7
8
9
10
 
  /*
   * 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... 
11
 
  #include <linux/dma-mapping.h>
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
12
13
14
 
  #include <linux/isa.h>
  
  static struct device isa_bus = {
1e0b2cf93   Kay Sievers   driver core: stru... 
15
 
  	.init_name	= "isa"
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
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
 
  };
  
  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;
5a244727f   William Breathitt Gray   isa: Prevent NULL... 
42
 
  	if (isa_driver && isa_driver->probe)
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
43
44
45
46
47
48
49
50
 
  		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;
5a244727f   William Breathitt Gray   isa: Prevent NULL... 
51
 
  	if (isa_driver && isa_driver->remove)
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
52
53
54
55
56
57
58
59
 
  		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;
5a244727f   William Breathitt Gray   isa: Prevent NULL... 
60
 
  	if (isa_driver && isa_driver->shutdown)
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
61
62
63
64
65
66
 
  		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;
5a244727f   William Breathitt Gray   isa: Prevent NULL... 
67
 
  	if (isa_driver && isa_driver->suspend)
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
68
69
70
71
72
73
74
75
 
  		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;
5a244727f   William Breathitt Gray   isa: Prevent NULL... 
76
 
  	if (isa_driver && isa_driver->resume)
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
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
 
  		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... 
133
134
 
  		dev_set_name(&isa_dev->dev, "%s.%u",
  			     isa_driver->driver.name, id);
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
135
136
137
 
  		isa_dev->dev.platform_data	= isa_driver;
  		isa_dev->dev.release		= isa_dev_release;
  		isa_dev->id			= id;
2f4f27d42   Yang Hongyang   dma-mapping: repl... 
138
 
  		isa_dev->dev.coherent_dma_mask = DMA_BIT_MASK(24);
00412be1d   Rene Herman   isa: set 24-bit d... 
139
 
  		isa_dev->dev.dma_mask = &isa_dev->dev.coherent_dma_mask;
a5117ba7d   Rene Herman   [PATCH] Driver mo... 
140
141
142
143
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
 
  		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;
  }
32a5a0c04   William Breathitt Gray   isa: Call isa_bus... 
175
 
  postcore_initcall(isa_bus_init);