PCI: pcie_portdriver: fix pcie_port_device_remove
[linux-2.6/mini2440.git] / drivers / acpi / sbshc.c
blob0619734895b29232d8f3b1e960efb8b777e808c5
1 /*
2 * SMBus driver for ACPI Embedded Controller (v0.1)
4 * Copyright (c) 2007 Alexey Starikovskiy
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation version 2.
9 */
11 #include <acpi/acpi_bus.h>
12 #include <acpi/acpi_drivers.h>
13 #include <linux/wait.h>
14 #include <linux/delay.h>
15 #include <linux/interrupt.h>
16 #include "sbshc.h"
18 #define ACPI_SMB_HC_CLASS "smbus_host_controller"
19 #define ACPI_SMB_HC_DEVICE_NAME "ACPI SMBus HC"
21 struct acpi_smb_hc {
22 struct acpi_ec *ec;
23 struct mutex lock;
24 wait_queue_head_t wait;
25 u8 offset;
26 u8 query_bit;
27 smbus_alarm_callback callback;
28 void *context;
31 static int acpi_smbus_hc_add(struct acpi_device *device);
32 static int acpi_smbus_hc_remove(struct acpi_device *device, int type);
34 static const struct acpi_device_id sbs_device_ids[] = {
35 {"ACPI0001", 0},
36 {"ACPI0005", 0},
37 {"", 0},
40 MODULE_DEVICE_TABLE(acpi, sbs_device_ids);
42 static struct acpi_driver acpi_smb_hc_driver = {
43 .name = "smbus_hc",
44 .class = ACPI_SMB_HC_CLASS,
45 .ids = sbs_device_ids,
46 .ops = {
47 .add = acpi_smbus_hc_add,
48 .remove = acpi_smbus_hc_remove,
52 union acpi_smb_status {
53 u8 raw;
54 struct {
55 u8 status:5;
56 u8 reserved:1;
57 u8 alarm:1;
58 u8 done:1;
59 } fields;
62 enum acpi_smb_status_codes {
63 SMBUS_OK = 0,
64 SMBUS_UNKNOWN_FAILURE = 0x07,
65 SMBUS_DEVICE_ADDRESS_NACK = 0x10,
66 SMBUS_DEVICE_ERROR = 0x11,
67 SMBUS_DEVICE_COMMAND_ACCESS_DENIED = 0x12,
68 SMBUS_UNKNOWN_ERROR = 0x13,
69 SMBUS_DEVICE_ACCESS_DENIED = 0x17,
70 SMBUS_TIMEOUT = 0x18,
71 SMBUS_HOST_UNSUPPORTED_PROTOCOL = 0x19,
72 SMBUS_BUSY = 0x1a,
73 SMBUS_PEC_ERROR = 0x1f,
76 enum acpi_smb_offset {
77 ACPI_SMB_PROTOCOL = 0, /* protocol, PEC */
78 ACPI_SMB_STATUS = 1, /* status */
79 ACPI_SMB_ADDRESS = 2, /* address */
80 ACPI_SMB_COMMAND = 3, /* command */
81 ACPI_SMB_DATA = 4, /* 32 data registers */
82 ACPI_SMB_BLOCK_COUNT = 0x24, /* number of data bytes */
83 ACPI_SMB_ALARM_ADDRESS = 0x25, /* alarm address */
84 ACPI_SMB_ALARM_DATA = 0x26, /* 2 bytes alarm data */
87 static inline int smb_hc_read(struct acpi_smb_hc *hc, u8 address, u8 *data)
89 return ec_read(hc->offset + address, data);
92 static inline int smb_hc_write(struct acpi_smb_hc *hc, u8 address, u8 data)
94 return ec_write(hc->offset + address, data);
97 static inline int smb_check_done(struct acpi_smb_hc *hc)
99 union acpi_smb_status status = {.raw = 0};
100 smb_hc_read(hc, ACPI_SMB_STATUS, &status.raw);
101 return status.fields.done && (status.fields.status == SMBUS_OK);
104 static int wait_transaction_complete(struct acpi_smb_hc *hc, int timeout)
106 if (wait_event_timeout(hc->wait, smb_check_done(hc),
107 msecs_to_jiffies(timeout)))
108 return 0;
110 * After the timeout happens, OS will try to check the status of SMbus.
111 * If the status is what OS expected, it will be regarded as the bogus
112 * timeout.
114 if (smb_check_done(hc))
115 return 0;
116 else
117 return -ETIME;
120 static int acpi_smbus_transaction(struct acpi_smb_hc *hc, u8 protocol,
121 u8 address, u8 command, u8 *data, u8 length)
123 int ret = -EFAULT, i;
124 u8 temp, sz = 0;
126 if (!hc) {
127 printk(KERN_ERR PREFIX "host controller is not configured\n");
128 return ret;
131 mutex_lock(&hc->lock);
132 if (smb_hc_read(hc, ACPI_SMB_PROTOCOL, &temp))
133 goto end;
134 if (temp) {
135 ret = -EBUSY;
136 goto end;
138 smb_hc_write(hc, ACPI_SMB_COMMAND, command);
139 if (!(protocol & 0x01)) {
140 smb_hc_write(hc, ACPI_SMB_BLOCK_COUNT, length);
141 for (i = 0; i < length; ++i)
142 smb_hc_write(hc, ACPI_SMB_DATA + i, data[i]);
144 smb_hc_write(hc, ACPI_SMB_ADDRESS, address << 1);
145 smb_hc_write(hc, ACPI_SMB_PROTOCOL, protocol);
147 * Wait for completion. Save the status code, data size,
148 * and data into the return package (if required by the protocol).
150 ret = wait_transaction_complete(hc, 1000);
151 if (ret || !(protocol & 0x01))
152 goto end;
153 switch (protocol) {
154 case SMBUS_RECEIVE_BYTE:
155 case SMBUS_READ_BYTE:
156 sz = 1;
157 break;
158 case SMBUS_READ_WORD:
159 sz = 2;
160 break;
161 case SMBUS_READ_BLOCK:
162 if (smb_hc_read(hc, ACPI_SMB_BLOCK_COUNT, &sz)) {
163 ret = -EFAULT;
164 goto end;
166 sz &= 0x1f;
167 break;
169 for (i = 0; i < sz; ++i)
170 smb_hc_read(hc, ACPI_SMB_DATA + i, &data[i]);
171 end:
172 mutex_unlock(&hc->lock);
173 return ret;
176 int acpi_smbus_read(struct acpi_smb_hc *hc, u8 protocol, u8 address,
177 u8 command, u8 *data)
179 return acpi_smbus_transaction(hc, protocol, address, command, data, 0);
182 EXPORT_SYMBOL_GPL(acpi_smbus_read);
184 int acpi_smbus_write(struct acpi_smb_hc *hc, u8 protocol, u8 address,
185 u8 command, u8 *data, u8 length)
187 return acpi_smbus_transaction(hc, protocol, address, command, data, length);
190 EXPORT_SYMBOL_GPL(acpi_smbus_write);
192 int acpi_smbus_register_callback(struct acpi_smb_hc *hc,
193 smbus_alarm_callback callback, void *context)
195 mutex_lock(&hc->lock);
196 hc->callback = callback;
197 hc->context = context;
198 mutex_unlock(&hc->lock);
199 return 0;
202 EXPORT_SYMBOL_GPL(acpi_smbus_register_callback);
204 int acpi_smbus_unregister_callback(struct acpi_smb_hc *hc)
206 mutex_lock(&hc->lock);
207 hc->callback = NULL;
208 hc->context = NULL;
209 mutex_unlock(&hc->lock);
210 return 0;
213 EXPORT_SYMBOL_GPL(acpi_smbus_unregister_callback);
215 static inline void acpi_smbus_callback(void *context)
217 struct acpi_smb_hc *hc = context;
218 if (hc->callback)
219 hc->callback(hc->context);
222 static int smbus_alarm(void *context)
224 struct acpi_smb_hc *hc = context;
225 union acpi_smb_status status;
226 u8 address;
227 if (smb_hc_read(hc, ACPI_SMB_STATUS, &status.raw))
228 return 0;
229 /* Check if it is only a completion notify */
230 if (status.fields.done)
231 wake_up(&hc->wait);
232 if (!status.fields.alarm)
233 return 0;
234 mutex_lock(&hc->lock);
235 smb_hc_read(hc, ACPI_SMB_ALARM_ADDRESS, &address);
236 status.fields.alarm = 0;
237 smb_hc_write(hc, ACPI_SMB_STATUS, status.raw);
238 /* We are only interested in events coming from known devices */
239 switch (address >> 1) {
240 case ACPI_SBS_CHARGER:
241 case ACPI_SBS_MANAGER:
242 case ACPI_SBS_BATTERY:
243 acpi_os_execute(OSL_GPE_HANDLER,
244 acpi_smbus_callback, hc);
245 default:;
247 mutex_unlock(&hc->lock);
248 return 0;
251 typedef int (*acpi_ec_query_func) (void *data);
253 extern int acpi_ec_add_query_handler(struct acpi_ec *ec, u8 query_bit,
254 acpi_handle handle, acpi_ec_query_func func,
255 void *data);
257 static int acpi_smbus_hc_add(struct acpi_device *device)
259 int status;
260 unsigned long long val;
261 struct acpi_smb_hc *hc;
263 if (!device)
264 return -EINVAL;
266 status = acpi_evaluate_integer(device->handle, "_EC", NULL, &val);
267 if (ACPI_FAILURE(status)) {
268 printk(KERN_ERR PREFIX "error obtaining _EC.\n");
269 return -EIO;
272 strcpy(acpi_device_name(device), ACPI_SMB_HC_DEVICE_NAME);
273 strcpy(acpi_device_class(device), ACPI_SMB_HC_CLASS);
275 hc = kzalloc(sizeof(struct acpi_smb_hc), GFP_KERNEL);
276 if (!hc)
277 return -ENOMEM;
278 mutex_init(&hc->lock);
279 init_waitqueue_head(&hc->wait);
281 hc->ec = acpi_driver_data(device->parent);
282 hc->offset = (val >> 8) & 0xff;
283 hc->query_bit = val & 0xff;
284 device->driver_data = hc;
286 acpi_ec_add_query_handler(hc->ec, hc->query_bit, NULL, smbus_alarm, hc);
287 printk(KERN_INFO PREFIX "SBS HC: EC = 0x%p, offset = 0x%0x, query_bit = 0x%0x\n",
288 hc->ec, hc->offset, hc->query_bit);
290 return 0;
293 extern void acpi_ec_remove_query_handler(struct acpi_ec *ec, u8 query_bit);
295 static int acpi_smbus_hc_remove(struct acpi_device *device, int type)
297 struct acpi_smb_hc *hc;
299 if (!device)
300 return -EINVAL;
302 hc = acpi_driver_data(device);
303 acpi_ec_remove_query_handler(hc->ec, hc->query_bit);
304 kfree(hc);
305 device->driver_data = NULL;
306 return 0;
309 static int __init acpi_smb_hc_init(void)
311 int result;
313 result = acpi_bus_register_driver(&acpi_smb_hc_driver);
314 if (result < 0)
315 return -ENODEV;
316 return 0;
319 static void __exit acpi_smb_hc_exit(void)
321 acpi_bus_unregister_driver(&acpi_smb_hc_driver);
324 module_init(acpi_smb_hc_init);
325 module_exit(acpi_smb_hc_exit);
327 MODULE_LICENSE("GPL");
328 MODULE_AUTHOR("Alexey Starikovskiy");
329 MODULE_DESCRIPTION("ACPI SMBus HC driver");