1
2
3
4
5
6
7
8
9
10
11
12
13
14
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#include <linux/pci.h>
54#include <linux/init.h>
55#include <linux/slab.h>
56#include "ibmasm.h"
57#include "lowlevel.h"
58#include "remote.h"
59
60int ibmasm_debug = 0;
61module_param(ibmasm_debug, int , S_IRUGO | S_IWUSR);
62MODULE_PARM_DESC(ibmasm_debug, " Set debug mode on or off");
63
64
65static int ibmasm_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
66{
67 int result;
68 struct service_processor *sp;
69
70 if ((result = pci_enable_device(pdev))) {
71 dev_err(&pdev->dev, "Failed to enable PCI device\n");
72 return result;
73 }
74 if ((result = pci_request_regions(pdev, DRIVER_NAME))) {
75 dev_err(&pdev->dev, "Failed to allocate PCI resources\n");
76 goto error_resources;
77 }
78
79 pci_set_master(pdev);
80
81 sp = kzalloc(sizeof(struct service_processor), GFP_KERNEL);
82 if (sp == NULL) {
83 dev_err(&pdev->dev, "Failed to allocate memory\n");
84 result = -ENOMEM;
85 goto error_kmalloc;
86 }
87
88 spin_lock_init(&sp->lock);
89 INIT_LIST_HEAD(&sp->command_queue);
90
91 pci_set_drvdata(pdev, (void *)sp);
92 sp->dev = &pdev->dev;
93 sp->number = pdev->bus->number;
94 snprintf(sp->dirname, IBMASM_NAME_SIZE, "%d", sp->number);
95 snprintf(sp->devname, IBMASM_NAME_SIZE, "%s%d", DRIVER_NAME, sp->number);
96
97 result = ibmasm_event_buffer_init(sp);
98 if (result) {
99 dev_err(sp->dev, "Failed to allocate event buffer\n");
100 goto error_eventbuffer;
101 }
102
103 result = ibmasm_heartbeat_init(sp);
104 if (result) {
105 dev_err(sp->dev, "Failed to allocate heartbeat command\n");
106 goto error_heartbeat;
107 }
108
109 sp->irq = pdev->irq;
110 sp->base_address = pci_ioremap_bar(pdev, 0);
111 if (!sp->base_address) {
112 dev_err(sp->dev, "Failed to ioremap pci memory\n");
113 result = -ENODEV;
114 goto error_ioremap;
115 }
116
117 result = request_irq(sp->irq, ibmasm_interrupt_handler, IRQF_SHARED, sp->devname, (void*)sp);
118 if (result) {
119 dev_err(sp->dev, "Failed to register interrupt handler\n");
120 goto error_request_irq;
121 }
122
123 enable_sp_interrupts(sp->base_address);
124
125 result = ibmasm_init_remote_input_dev(sp);
126 if (result) {
127 dev_err(sp->dev, "Failed to initialize remote queue\n");
128 goto error_send_message;
129 }
130
131 result = ibmasm_send_driver_vpd(sp);
132 if (result) {
133 dev_err(sp->dev, "Failed to send driver VPD to service processor\n");
134 goto error_send_message;
135 }
136 result = ibmasm_send_os_state(sp, SYSTEM_STATE_OS_UP);
137 if (result) {
138 dev_err(sp->dev, "Failed to send OS state to service processor\n");
139 goto error_send_message;
140 }
141 ibmasmfs_add_sp(sp);
142
143 ibmasm_register_uart(sp);
144
145 return 0;
146
147error_send_message:
148 disable_sp_interrupts(sp->base_address);
149 ibmasm_free_remote_input_dev(sp);
150 free_irq(sp->irq, (void *)sp);
151error_request_irq:
152 iounmap(sp->base_address);
153error_ioremap:
154 ibmasm_heartbeat_exit(sp);
155error_heartbeat:
156 ibmasm_event_buffer_exit(sp);
157error_eventbuffer:
158 kfree(sp);
159error_kmalloc:
160 pci_release_regions(pdev);
161error_resources:
162 pci_disable_device(pdev);
163
164 return result;
165}
166
167static void ibmasm_remove_one(struct pci_dev *pdev)
168{
169 struct service_processor *sp = pci_get_drvdata(pdev);
170
171 dbg("Unregistering UART\n");
172 ibmasm_unregister_uart(sp);
173 dbg("Sending OS down message\n");
174 if (ibmasm_send_os_state(sp, SYSTEM_STATE_OS_DOWN))
175 err("failed to get response to 'Send OS State' command\n");
176 dbg("Disabling heartbeats\n");
177 ibmasm_heartbeat_exit(sp);
178 dbg("Disabling interrupts\n");
179 disable_sp_interrupts(sp->base_address);
180 dbg("Freeing SP irq\n");
181 free_irq(sp->irq, (void *)sp);
182 dbg("Cleaning up\n");
183 ibmasm_free_remote_input_dev(sp);
184 iounmap(sp->base_address);
185 ibmasm_event_buffer_exit(sp);
186 kfree(sp);
187 pci_release_regions(pdev);
188 pci_disable_device(pdev);
189}
190
191static struct pci_device_id ibmasm_pci_table[] =
192{
193 { PCI_DEVICE(VENDORID_IBM, DEVICEID_RSA) },
194 {},
195};
196
197static struct pci_driver ibmasm_driver = {
198 .name = DRIVER_NAME,
199 .id_table = ibmasm_pci_table,
200 .probe = ibmasm_init_one,
201 .remove = ibmasm_remove_one,
202};
203
204static void __exit ibmasm_exit (void)
205{
206 ibmasm_unregister_panic_notifier();
207 ibmasmfs_unregister();
208 pci_unregister_driver(&ibmasm_driver);
209 info(DRIVER_DESC " version " DRIVER_VERSION " unloaded");
210}
211
212static int __init ibmasm_init(void)
213{
214 int result = pci_register_driver(&ibmasm_driver);
215 if (result)
216 return result;
217
218 result = ibmasmfs_register();
219 if (result) {
220 pci_unregister_driver(&ibmasm_driver);
221 err("Failed to register ibmasmfs file system");
222 return result;
223 }
224
225 ibmasm_register_panic_notifier();
226 info(DRIVER_DESC " version " DRIVER_VERSION " loaded");
227 return 0;
228}
229
230module_init(ibmasm_init);
231module_exit(ibmasm_exit);
232
233MODULE_AUTHOR(DRIVER_AUTHOR);
234MODULE_DESCRIPTION(DRIVER_DESC);
235MODULE_LICENSE("GPL");
236MODULE_DEVICE_TABLE(pci, ibmasm_pci_table);
237
238