added 2.6.29.6 aldebaran kernel
[nao-ulib.git] / kernel / 2.6.29.6-aldebaran-rt / drivers / acpi / ec.c
blobf30c8f4485258b2f0a2cb05bf7cb38a6bcf59e86
1 /*
2 * ec.c - ACPI Embedded Controller Driver (v2.1)
4 * Copyright (C) 2006-2008 Alexey Starikovskiy <astarikovskiy@suse.de>
5 * Copyright (C) 2006 Denis Sadykov <denis.m.sadykov@intel.com>
6 * Copyright (C) 2004 Luming Yu <luming.yu@intel.com>
7 * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
8 * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
10 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or (at
15 * your option) any later version.
17 * This program is distributed in the hope that it will be useful, but
18 * WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
20 * General Public License for more details.
22 * You should have received a copy of the GNU General Public License along
23 * with this program; if not, write to the Free Software Foundation, Inc.,
24 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
26 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
29 /* Uncomment next line to get verbose printout */
30 /* #define DEBUG */
32 #include <linux/kernel.h>
33 #include <linux/module.h>
34 #include <linux/init.h>
35 #include <linux/types.h>
36 #include <linux/delay.h>
37 #include <linux/proc_fs.h>
38 #include <linux/seq_file.h>
39 #include <linux/interrupt.h>
40 #include <linux/list.h>
41 #include <linux/spinlock.h>
42 #include <asm/io.h>
43 #include <acpi/acpi_bus.h>
44 #include <acpi/acpi_drivers.h>
46 #define ACPI_EC_CLASS "embedded_controller"
47 #define ACPI_EC_DEVICE_NAME "Embedded Controller"
48 #define ACPI_EC_FILE_INFO "info"
50 #undef PREFIX
51 #define PREFIX "ACPI: EC: "
53 /* EC status register */
54 #define ACPI_EC_FLAG_OBF 0x01 /* Output buffer full */
55 #define ACPI_EC_FLAG_IBF 0x02 /* Input buffer full */
56 #define ACPI_EC_FLAG_BURST 0x10 /* burst mode */
57 #define ACPI_EC_FLAG_SCI 0x20 /* EC-SCI occurred */
59 /* EC commands */
60 enum ec_command {
61 ACPI_EC_COMMAND_READ = 0x80,
62 ACPI_EC_COMMAND_WRITE = 0x81,
63 ACPI_EC_BURST_ENABLE = 0x82,
64 ACPI_EC_BURST_DISABLE = 0x83,
65 ACPI_EC_COMMAND_QUERY = 0x84,
68 #define ACPI_EC_DELAY 500 /* Wait 500ms max. during EC ops */
69 #define ACPI_EC_UDELAY_GLK 1000 /* Wait 1ms max. to get global lock */
70 #define ACPI_EC_UDELAY 100 /* Wait 100us before polling EC again */
72 #define ACPI_EC_STORM_THRESHOLD 8 /* number of false interrupts
73 per one transaction */
75 enum {
76 EC_FLAGS_QUERY_PENDING, /* Query is pending */
77 EC_FLAGS_GPE_MODE, /* Expect GPE to be sent
78 * for status change */
79 EC_FLAGS_NO_GPE, /* Don't use GPE mode */
80 EC_FLAGS_GPE_STORM, /* GPE storm detected */
81 EC_FLAGS_HANDLERS_INSTALLED /* Handlers for GPE and
82 * OpReg are installed */
85 /* If we find an EC via the ECDT, we need to keep a ptr to its context */
86 /* External interfaces use first EC only, so remember */
87 typedef int (*acpi_ec_query_func) (void *data);
89 struct acpi_ec_query_handler {
90 struct list_head node;
91 acpi_ec_query_func func;
92 acpi_handle handle;
93 void *data;
94 u8 query_bit;
97 struct transaction {
98 const u8 *wdata;
99 u8 *rdata;
100 unsigned short irq_count;
101 u8 command;
102 u8 wi;
103 u8 ri;
104 u8 wlen;
105 u8 rlen;
106 bool done;
109 static struct acpi_ec {
110 acpi_handle handle;
111 unsigned long gpe;
112 unsigned long command_addr;
113 unsigned long data_addr;
114 unsigned long global_lock;
115 unsigned long flags;
116 struct mutex lock;
117 wait_queue_head_t wait;
118 struct list_head list;
119 struct transaction *curr;
120 spinlock_t curr_lock;
121 } *boot_ec, *first_ec;
123 static int EC_FLAGS_MSI; /* Out-of-spec MSI controller */
125 /* --------------------------------------------------------------------------
126 Transaction Management
127 -------------------------------------------------------------------------- */
129 static inline u8 acpi_ec_read_status(struct acpi_ec *ec)
131 u8 x = inb(ec->command_addr);
132 pr_debug(PREFIX "---> status = 0x%2.2x\n", x);
133 return x;
136 static inline u8 acpi_ec_read_data(struct acpi_ec *ec)
138 u8 x = inb(ec->data_addr);
139 pr_debug(PREFIX "---> data = 0x%2.2x\n", x);
140 return x;
143 static inline void acpi_ec_write_cmd(struct acpi_ec *ec, u8 command)
145 pr_debug(PREFIX "<--- command = 0x%2.2x\n", command);
146 outb(command, ec->command_addr);
149 static inline void acpi_ec_write_data(struct acpi_ec *ec, u8 data)
151 pr_debug(PREFIX "<--- data = 0x%2.2x\n", data);
152 outb(data, ec->data_addr);
155 static int ec_transaction_done(struct acpi_ec *ec)
157 unsigned long flags;
158 int ret = 0;
159 spin_lock_irqsave(&ec->curr_lock, flags);
160 if (!ec->curr || ec->curr->done)
161 ret = 1;
162 spin_unlock_irqrestore(&ec->curr_lock, flags);
163 return ret;
166 static void start_transaction(struct acpi_ec *ec)
168 ec->curr->irq_count = ec->curr->wi = ec->curr->ri = 0;
169 ec->curr->done = false;
170 acpi_ec_write_cmd(ec, ec->curr->command);
173 static void gpe_transaction(struct acpi_ec *ec, u8 status)
175 unsigned long flags;
176 spin_lock_irqsave(&ec->curr_lock, flags);
177 if (!ec->curr)
178 goto unlock;
179 if (ec->curr->wlen > ec->curr->wi) {
180 if ((status & ACPI_EC_FLAG_IBF) == 0)
181 acpi_ec_write_data(ec,
182 ec->curr->wdata[ec->curr->wi++]);
183 else
184 goto err;
185 } else if (ec->curr->rlen > ec->curr->ri) {
186 if ((status & ACPI_EC_FLAG_OBF) == 1) {
187 ec->curr->rdata[ec->curr->ri++] = acpi_ec_read_data(ec);
188 if (ec->curr->rlen == ec->curr->ri)
189 ec->curr->done = true;
190 } else
191 goto err;
192 } else if (ec->curr->wlen == ec->curr->wi &&
193 (status & ACPI_EC_FLAG_IBF) == 0)
194 ec->curr->done = true;
195 goto unlock;
196 err:
197 /* false interrupt, state didn't change */
198 if (in_interrupt())
199 ++ec->curr->irq_count;
200 unlock:
201 spin_unlock_irqrestore(&ec->curr_lock, flags);
204 static int acpi_ec_wait(struct acpi_ec *ec)
206 if (wait_event_timeout(ec->wait, ec_transaction_done(ec),
207 msecs_to_jiffies(ACPI_EC_DELAY)))
208 return 0;
209 /* try restart command if we get any false interrupts */
210 if (ec->curr->irq_count &&
211 (acpi_ec_read_status(ec) & ACPI_EC_FLAG_IBF) == 0) {
212 pr_debug(PREFIX "controller reset, restart transaction\n");
213 start_transaction(ec);
214 if (wait_event_timeout(ec->wait, ec_transaction_done(ec),
215 msecs_to_jiffies(ACPI_EC_DELAY)))
216 return 0;
218 /* missing GPEs, switch back to poll mode */
219 if (printk_ratelimit())
220 pr_info(PREFIX "missing confirmations, "
221 "switch off interrupt mode.\n");
222 set_bit(EC_FLAGS_NO_GPE, &ec->flags);
223 clear_bit(EC_FLAGS_GPE_MODE, &ec->flags);
224 return 1;
227 static void acpi_ec_gpe_query(void *ec_cxt);
229 static int ec_check_sci(struct acpi_ec *ec, u8 state)
231 if (state & ACPI_EC_FLAG_SCI) {
232 if (!test_and_set_bit(EC_FLAGS_QUERY_PENDING, &ec->flags))
233 return acpi_os_execute(OSL_EC_BURST_HANDLER,
234 acpi_ec_gpe_query, ec);
236 return 0;
239 static int ec_poll(struct acpi_ec *ec)
241 unsigned long delay = jiffies + msecs_to_jiffies(ACPI_EC_DELAY);
242 udelay(ACPI_EC_UDELAY);
243 while (time_before(jiffies, delay)) {
244 gpe_transaction(ec, acpi_ec_read_status(ec));
245 udelay(ACPI_EC_UDELAY);
246 if (ec_transaction_done(ec))
247 return 0;
249 return -ETIME;
252 static int acpi_ec_transaction_unlocked(struct acpi_ec *ec,
253 struct transaction *t,
254 int force_poll)
256 unsigned long tmp;
257 int ret = 0;
258 pr_debug(PREFIX "transaction start\n");
259 /* disable GPE during transaction if storm is detected */
260 if (test_bit(EC_FLAGS_GPE_STORM, &ec->flags)) {
261 clear_bit(EC_FLAGS_GPE_MODE, &ec->flags);
262 acpi_disable_gpe(NULL, ec->gpe);
264 if (EC_FLAGS_MSI)
265 udelay(ACPI_EC_DELAY);
266 /* start transaction */
267 spin_lock_irqsave(&ec->curr_lock, tmp);
268 /* following two actions should be kept atomic */
269 ec->curr = t;
270 start_transaction(ec);
271 if (ec->curr->command == ACPI_EC_COMMAND_QUERY)
272 clear_bit(EC_FLAGS_QUERY_PENDING, &ec->flags);
273 spin_unlock_irqrestore(&ec->curr_lock, tmp);
274 /* if we selected poll mode or failed in GPE-mode do a poll loop */
275 if (force_poll ||
276 !test_bit(EC_FLAGS_GPE_MODE, &ec->flags) ||
277 acpi_ec_wait(ec))
278 ret = ec_poll(ec);
279 pr_debug(PREFIX "transaction end\n");
280 spin_lock_irqsave(&ec->curr_lock, tmp);
281 ec->curr = NULL;
282 spin_unlock_irqrestore(&ec->curr_lock, tmp);
283 if (test_bit(EC_FLAGS_GPE_STORM, &ec->flags)) {
284 /* check if we received SCI during transaction */
285 ec_check_sci(ec, acpi_ec_read_status(ec));
286 /* it is safe to enable GPE outside of transaction */
287 acpi_enable_gpe(NULL, ec->gpe);
288 } else if (test_bit(EC_FLAGS_GPE_MODE, &ec->flags) &&
289 t->irq_count > ACPI_EC_STORM_THRESHOLD) {
290 pr_info(PREFIX "GPE storm detected, "
291 "transactions will use polling mode\n");
292 set_bit(EC_FLAGS_GPE_STORM, &ec->flags);
294 return ret;
297 static int ec_check_ibf0(struct acpi_ec *ec)
299 u8 status = acpi_ec_read_status(ec);
300 return (status & ACPI_EC_FLAG_IBF) == 0;
303 static int ec_wait_ibf0(struct acpi_ec *ec)
305 unsigned long delay = jiffies + msecs_to_jiffies(ACPI_EC_DELAY);
306 /* interrupt wait manually if GPE mode is not active */
307 unsigned long timeout = test_bit(EC_FLAGS_GPE_MODE, &ec->flags) ?
308 msecs_to_jiffies(ACPI_EC_DELAY) : msecs_to_jiffies(1);
309 while (time_before(jiffies, delay))
310 if (wait_event_timeout(ec->wait, ec_check_ibf0(ec), timeout))
311 return 0;
312 return -ETIME;
315 static int acpi_ec_transaction(struct acpi_ec *ec, struct transaction *t,
316 int force_poll)
318 int status;
319 u32 glk;
320 if (!ec || (!t) || (t->wlen && !t->wdata) || (t->rlen && !t->rdata))
321 return -EINVAL;
322 if (t->rdata)
323 memset(t->rdata, 0, t->rlen);
324 mutex_lock(&ec->lock);
325 if (ec->global_lock) {
326 status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk);
327 if (ACPI_FAILURE(status)) {
328 status = -ENODEV;
329 goto unlock;
332 if (ec_wait_ibf0(ec)) {
333 pr_err(PREFIX "input buffer is not empty, "
334 "aborting transaction\n");
335 status = -ETIME;
336 goto end;
338 status = acpi_ec_transaction_unlocked(ec, t, force_poll);
339 end:
340 if (ec->global_lock)
341 acpi_release_global_lock(glk);
342 unlock:
343 mutex_unlock(&ec->lock);
344 return status;
348 * Note: samsung nv5000 doesn't work with ec burst mode.
349 * http://bugzilla.kernel.org/show_bug.cgi?id=4980
351 static int acpi_ec_burst_enable(struct acpi_ec *ec)
353 u8 d;
354 struct transaction t = {.command = ACPI_EC_BURST_ENABLE,
355 .wdata = NULL, .rdata = &d,
356 .wlen = 0, .rlen = 1};
358 return acpi_ec_transaction(ec, &t, 0);
361 static int acpi_ec_burst_disable(struct acpi_ec *ec)
363 struct transaction t = {.command = ACPI_EC_BURST_DISABLE,
364 .wdata = NULL, .rdata = NULL,
365 .wlen = 0, .rlen = 0};
367 return (acpi_ec_read_status(ec) & ACPI_EC_FLAG_BURST) ?
368 acpi_ec_transaction(ec, &t, 0) : 0;
371 static int acpi_ec_read(struct acpi_ec *ec, u8 address, u8 * data)
373 int result;
374 u8 d;
375 struct transaction t = {.command = ACPI_EC_COMMAND_READ,
376 .wdata = &address, .rdata = &d,
377 .wlen = 1, .rlen = 1};
379 result = acpi_ec_transaction(ec, &t, 0);
380 *data = d;
381 return result;
384 static int acpi_ec_write(struct acpi_ec *ec, u8 address, u8 data)
386 u8 wdata[2] = { address, data };
387 struct transaction t = {.command = ACPI_EC_COMMAND_WRITE,
388 .wdata = wdata, .rdata = NULL,
389 .wlen = 2, .rlen = 0};
391 return acpi_ec_transaction(ec, &t, 0);
395 * Externally callable EC access functions. For now, assume 1 EC only
397 int ec_burst_enable(void)
399 if (!first_ec)
400 return -ENODEV;
401 return acpi_ec_burst_enable(first_ec);
404 EXPORT_SYMBOL(ec_burst_enable);
406 int ec_burst_disable(void)
408 if (!first_ec)
409 return -ENODEV;
410 return acpi_ec_burst_disable(first_ec);
413 EXPORT_SYMBOL(ec_burst_disable);
415 int ec_read(u8 addr, u8 * val)
417 int err;
418 u8 temp_data;
420 if (!first_ec)
421 return -ENODEV;
423 err = acpi_ec_read(first_ec, addr, &temp_data);
425 if (!err) {
426 *val = temp_data;
427 return 0;
428 } else
429 return err;
432 EXPORT_SYMBOL(ec_read);
434 int ec_write(u8 addr, u8 val)
436 int err;
438 if (!first_ec)
439 return -ENODEV;
441 err = acpi_ec_write(first_ec, addr, val);
443 return err;
446 EXPORT_SYMBOL(ec_write);
448 int ec_transaction(u8 command,
449 const u8 * wdata, unsigned wdata_len,
450 u8 * rdata, unsigned rdata_len,
451 int force_poll)
453 struct transaction t = {.command = command,
454 .wdata = wdata, .rdata = rdata,
455 .wlen = wdata_len, .rlen = rdata_len};
456 if (!first_ec)
457 return -ENODEV;
459 return acpi_ec_transaction(first_ec, &t, force_poll);
462 EXPORT_SYMBOL(ec_transaction);
464 static int acpi_ec_query(struct acpi_ec *ec, u8 * data)
466 int result;
467 u8 d;
468 struct transaction t = {.command = ACPI_EC_COMMAND_QUERY,
469 .wdata = NULL, .rdata = &d,
470 .wlen = 0, .rlen = 1};
471 if (!ec || !data)
472 return -EINVAL;
475 * Query the EC to find out which _Qxx method we need to evaluate.
476 * Note that successful completion of the query causes the ACPI_EC_SCI
477 * bit to be cleared (and thus clearing the interrupt source).
480 result = acpi_ec_transaction(ec, &t, 0);
481 if (result)
482 return result;
484 if (!d)
485 return -ENODATA;
487 *data = d;
488 return 0;
491 /* --------------------------------------------------------------------------
492 Event Management
493 -------------------------------------------------------------------------- */
494 int acpi_ec_add_query_handler(struct acpi_ec *ec, u8 query_bit,
495 acpi_handle handle, acpi_ec_query_func func,
496 void *data)
498 struct acpi_ec_query_handler *handler =
499 kzalloc(sizeof(struct acpi_ec_query_handler), GFP_KERNEL);
500 if (!handler)
501 return -ENOMEM;
503 handler->query_bit = query_bit;
504 handler->handle = handle;
505 handler->func = func;
506 handler->data = data;
507 mutex_lock(&ec->lock);
508 list_add(&handler->node, &ec->list);
509 mutex_unlock(&ec->lock);
510 return 0;
513 EXPORT_SYMBOL_GPL(acpi_ec_add_query_handler);
515 void acpi_ec_remove_query_handler(struct acpi_ec *ec, u8 query_bit)
517 struct acpi_ec_query_handler *handler, *tmp;
518 mutex_lock(&ec->lock);
519 list_for_each_entry_safe(handler, tmp, &ec->list, node) {
520 if (query_bit == handler->query_bit) {
521 list_del(&handler->node);
522 kfree(handler);
525 mutex_unlock(&ec->lock);
528 EXPORT_SYMBOL_GPL(acpi_ec_remove_query_handler);
530 static void acpi_ec_gpe_query(void *ec_cxt)
532 struct acpi_ec *ec = ec_cxt;
533 u8 value = 0;
534 struct acpi_ec_query_handler *handler, copy;
536 if (!ec || acpi_ec_query(ec, &value))
537 return;
538 mutex_lock(&ec->lock);
539 list_for_each_entry(handler, &ec->list, node) {
540 if (value == handler->query_bit) {
541 /* have custom handler for this bit */
542 memcpy(&copy, handler, sizeof(copy));
543 mutex_unlock(&ec->lock);
544 if (copy.func) {
545 copy.func(copy.data);
546 } else if (copy.handle) {
547 acpi_evaluate_object(copy.handle, NULL, NULL, NULL);
549 return;
552 mutex_unlock(&ec->lock);
555 static u32 acpi_ec_gpe_handler(void *data)
557 struct acpi_ec *ec = data;
558 u8 status;
560 pr_debug(PREFIX "~~~> interrupt\n");
561 status = acpi_ec_read_status(ec);
563 if (test_bit(EC_FLAGS_GPE_MODE, &ec->flags)) {
564 gpe_transaction(ec, status);
565 if (ec_transaction_done(ec) &&
566 (status & ACPI_EC_FLAG_IBF) == 0) {
567 #if 0
568 wake_up(&ec->wait);
569 #else
570 // hack ...
571 if (waitqueue_active(&ec->wait)) {
572 struct task_struct *task;
574 task = list_entry(ec->wait.task_list.next,
575 wait_queue_t, task_list)->private;
576 if (task)
577 wake_up_process(task);
579 #endif
583 ec_check_sci(ec, status);
584 if (!test_bit(EC_FLAGS_GPE_MODE, &ec->flags) &&
585 !test_bit(EC_FLAGS_NO_GPE, &ec->flags)) {
586 /* this is non-query, must be confirmation */
587 if (!test_bit(EC_FLAGS_GPE_STORM, &ec->flags)) {
588 if (printk_ratelimit())
589 pr_info(PREFIX "non-query interrupt received,"
590 " switching to interrupt mode\n");
591 } else {
592 /* hush, STORM switches the mode every transaction */
593 pr_debug(PREFIX "non-query interrupt received,"
594 " switching to interrupt mode\n");
596 set_bit(EC_FLAGS_GPE_MODE, &ec->flags);
598 return ACPI_INTERRUPT_HANDLED;
601 /* --------------------------------------------------------------------------
602 Address Space Management
603 -------------------------------------------------------------------------- */
605 static acpi_status
606 acpi_ec_space_handler(u32 function, acpi_physical_address address,
607 u32 bits, acpi_integer *value,
608 void *handler_context, void *region_context)
610 struct acpi_ec *ec = handler_context;
611 int result = 0, i;
612 u8 temp = 0;
614 if ((address > 0xFF) || !value || !handler_context)
615 return AE_BAD_PARAMETER;
617 if (function != ACPI_READ && function != ACPI_WRITE)
618 return AE_BAD_PARAMETER;
620 if (bits != 8 && acpi_strict)
621 return AE_BAD_PARAMETER;
623 acpi_ec_burst_enable(ec);
625 if (function == ACPI_READ) {
626 result = acpi_ec_read(ec, address, &temp);
627 *value = temp;
628 } else {
629 temp = 0xff & (*value);
630 result = acpi_ec_write(ec, address, temp);
633 for (i = 8; unlikely(bits - i > 0); i += 8) {
634 ++address;
635 if (function == ACPI_READ) {
636 result = acpi_ec_read(ec, address, &temp);
637 (*value) |= ((acpi_integer)temp) << i;
638 } else {
639 temp = 0xff & ((*value) >> i);
640 result = acpi_ec_write(ec, address, temp);
644 acpi_ec_burst_disable(ec);
646 switch (result) {
647 case -EINVAL:
648 return AE_BAD_PARAMETER;
649 break;
650 case -ENODEV:
651 return AE_NOT_FOUND;
652 break;
653 case -ETIME:
654 return AE_TIME;
655 break;
656 default:
657 return AE_OK;
661 /* --------------------------------------------------------------------------
662 FS Interface (/proc)
663 -------------------------------------------------------------------------- */
665 static struct proc_dir_entry *acpi_ec_dir;
667 static int acpi_ec_read_info(struct seq_file *seq, void *offset)
669 struct acpi_ec *ec = seq->private;
671 if (!ec)
672 goto end;
674 seq_printf(seq, "gpe:\t\t\t0x%02x\n", (u32) ec->gpe);
675 seq_printf(seq, "ports:\t\t\t0x%02x, 0x%02x\n",
676 (unsigned)ec->command_addr, (unsigned)ec->data_addr);
677 seq_printf(seq, "use global lock:\t%s\n",
678 ec->global_lock ? "yes" : "no");
679 end:
680 return 0;
683 static int acpi_ec_info_open_fs(struct inode *inode, struct file *file)
685 return single_open(file, acpi_ec_read_info, PDE(inode)->data);
688 static struct file_operations acpi_ec_info_ops = {
689 .open = acpi_ec_info_open_fs,
690 .read = seq_read,
691 .llseek = seq_lseek,
692 .release = single_release,
693 .owner = THIS_MODULE,
696 static int acpi_ec_add_fs(struct acpi_device *device)
698 struct proc_dir_entry *entry = NULL;
700 if (!acpi_device_dir(device)) {
701 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
702 acpi_ec_dir);
703 if (!acpi_device_dir(device))
704 return -ENODEV;
707 entry = proc_create_data(ACPI_EC_FILE_INFO, S_IRUGO,
708 acpi_device_dir(device),
709 &acpi_ec_info_ops, acpi_driver_data(device));
710 if (!entry)
711 return -ENODEV;
712 return 0;
715 static int acpi_ec_remove_fs(struct acpi_device *device)
718 if (acpi_device_dir(device)) {
719 remove_proc_entry(ACPI_EC_FILE_INFO, acpi_device_dir(device));
720 remove_proc_entry(acpi_device_bid(device), acpi_ec_dir);
721 acpi_device_dir(device) = NULL;
724 return 0;
727 /* --------------------------------------------------------------------------
728 Driver Interface
729 -------------------------------------------------------------------------- */
730 static acpi_status
731 ec_parse_io_ports(struct acpi_resource *resource, void *context);
733 static struct acpi_ec *make_acpi_ec(void)
735 struct acpi_ec *ec = kzalloc(sizeof(struct acpi_ec), GFP_KERNEL);
736 if (!ec)
737 return NULL;
738 ec->flags = 1 << EC_FLAGS_QUERY_PENDING;
739 mutex_init(&ec->lock);
740 init_waitqueue_head(&ec->wait);
741 INIT_LIST_HEAD(&ec->list);
742 spin_lock_init(&ec->curr_lock);
743 return ec;
746 static acpi_status
747 acpi_ec_register_query_methods(acpi_handle handle, u32 level,
748 void *context, void **return_value)
750 char node_name[5];
751 struct acpi_buffer buffer = { sizeof(node_name), node_name };
752 struct acpi_ec *ec = context;
753 int value = 0;
754 acpi_status status;
756 status = acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer);
758 if (ACPI_SUCCESS(status) && sscanf(node_name, "_Q%x", &value) == 1) {
759 acpi_ec_add_query_handler(ec, value, handle, NULL, NULL);
761 return AE_OK;
764 static acpi_status
765 ec_parse_device(acpi_handle handle, u32 Level, void *context, void **retval)
767 acpi_status status;
768 unsigned long long tmp = 0;
770 struct acpi_ec *ec = context;
771 status = acpi_walk_resources(handle, METHOD_NAME__CRS,
772 ec_parse_io_ports, ec);
773 if (ACPI_FAILURE(status))
774 return status;
776 /* Get GPE bit assignment (EC events). */
777 /* TODO: Add support for _GPE returning a package */
778 status = acpi_evaluate_integer(handle, "_GPE", NULL, &tmp);
779 if (ACPI_FAILURE(status))
780 return status;
781 ec->gpe = tmp;
782 /* Use the global lock for all EC transactions? */
783 tmp = 0;
784 acpi_evaluate_integer(handle, "_GLK", NULL, &tmp);
785 ec->global_lock = tmp;
786 ec->handle = handle;
787 return AE_CTRL_TERMINATE;
790 static void ec_remove_handlers(struct acpi_ec *ec)
792 if (ACPI_FAILURE(acpi_remove_address_space_handler(ec->handle,
793 ACPI_ADR_SPACE_EC, &acpi_ec_space_handler)))
794 pr_err(PREFIX "failed to remove space handler\n");
795 if (ACPI_FAILURE(acpi_remove_gpe_handler(NULL, ec->gpe,
796 &acpi_ec_gpe_handler)))
797 pr_err(PREFIX "failed to remove gpe handler\n");
798 clear_bit(EC_FLAGS_HANDLERS_INSTALLED, &ec->flags);
801 static int acpi_ec_add(struct acpi_device *device)
803 struct acpi_ec *ec = NULL;
805 if (!device)
806 return -EINVAL;
807 strcpy(acpi_device_name(device), ACPI_EC_DEVICE_NAME);
808 strcpy(acpi_device_class(device), ACPI_EC_CLASS);
810 /* Check for boot EC */
811 if (boot_ec &&
812 (boot_ec->handle == device->handle ||
813 boot_ec->handle == ACPI_ROOT_OBJECT)) {
814 ec = boot_ec;
815 boot_ec = NULL;
816 } else {
817 ec = make_acpi_ec();
818 if (!ec)
819 return -ENOMEM;
820 if (ec_parse_device(device->handle, 0, ec, NULL) !=
821 AE_CTRL_TERMINATE) {
822 kfree(ec);
823 return -EINVAL;
827 ec->handle = device->handle;
829 /* Find and register all query methods */
830 acpi_walk_namespace(ACPI_TYPE_METHOD, ec->handle, 1,
831 acpi_ec_register_query_methods, ec, NULL);
833 if (!first_ec)
834 first_ec = ec;
835 device->driver_data = ec;
836 acpi_ec_add_fs(device);
837 pr_info(PREFIX "GPE = 0x%lx, I/O: command/status = 0x%lx, data = 0x%lx\n",
838 ec->gpe, ec->command_addr, ec->data_addr);
839 pr_info(PREFIX "driver started in %s mode\n",
840 (test_bit(EC_FLAGS_GPE_MODE, &ec->flags))?"interrupt":"poll");
841 return 0;
844 static int acpi_ec_remove(struct acpi_device *device, int type)
846 struct acpi_ec *ec;
847 struct acpi_ec_query_handler *handler, *tmp;
849 if (!device)
850 return -EINVAL;
852 ec = acpi_driver_data(device);
853 mutex_lock(&ec->lock);
854 list_for_each_entry_safe(handler, tmp, &ec->list, node) {
855 list_del(&handler->node);
856 kfree(handler);
858 mutex_unlock(&ec->lock);
859 acpi_ec_remove_fs(device);
860 device->driver_data = NULL;
861 if (ec == first_ec)
862 first_ec = NULL;
863 kfree(ec);
864 return 0;
867 static acpi_status
868 ec_parse_io_ports(struct acpi_resource *resource, void *context)
870 struct acpi_ec *ec = context;
872 if (resource->type != ACPI_RESOURCE_TYPE_IO)
873 return AE_OK;
876 * The first address region returned is the data port, and
877 * the second address region returned is the status/command
878 * port.
880 if (ec->data_addr == 0)
881 ec->data_addr = resource->data.io.minimum;
882 else if (ec->command_addr == 0)
883 ec->command_addr = resource->data.io.minimum;
884 else
885 return AE_CTRL_TERMINATE;
887 return AE_OK;
890 static int ec_install_handlers(struct acpi_ec *ec)
892 acpi_status status;
893 if (test_bit(EC_FLAGS_HANDLERS_INSTALLED, &ec->flags))
894 return 0;
895 status = acpi_install_gpe_handler(NULL, ec->gpe,
896 ACPI_GPE_EDGE_TRIGGERED,
897 &acpi_ec_gpe_handler, ec);
898 if (ACPI_FAILURE(status))
899 return -ENODEV;
900 acpi_set_gpe_type(NULL, ec->gpe, ACPI_GPE_TYPE_RUNTIME);
901 acpi_enable_gpe(NULL, ec->gpe);
902 status = acpi_install_address_space_handler(ec->handle,
903 ACPI_ADR_SPACE_EC,
904 &acpi_ec_space_handler,
905 NULL, ec);
906 if (ACPI_FAILURE(status)) {
907 if (status == AE_NOT_FOUND) {
909 * Maybe OS fails in evaluating the _REG object.
910 * The AE_NOT_FOUND error will be ignored and OS
911 * continue to initialize EC.
913 printk(KERN_ERR "Fail in evaluating the _REG object"
914 " of EC device. Broken bios is suspected.\n");
915 } else {
916 acpi_remove_gpe_handler(NULL, ec->gpe,
917 &acpi_ec_gpe_handler);
918 return -ENODEV;
922 set_bit(EC_FLAGS_HANDLERS_INSTALLED, &ec->flags);
923 return 0;
926 static int acpi_ec_start(struct acpi_device *device)
928 struct acpi_ec *ec;
929 int ret = 0;
931 if (!device)
932 return -EINVAL;
934 ec = acpi_driver_data(device);
936 if (!ec)
937 return -EINVAL;
939 ret = ec_install_handlers(ec);
941 /* EC is fully operational, allow queries */
942 clear_bit(EC_FLAGS_QUERY_PENDING, &ec->flags);
943 return ret;
946 static int acpi_ec_stop(struct acpi_device *device, int type)
948 struct acpi_ec *ec;
949 if (!device)
950 return -EINVAL;
951 ec = acpi_driver_data(device);
952 if (!ec)
953 return -EINVAL;
954 ec_remove_handlers(ec);
956 return 0;
959 int __init acpi_boot_ec_enable(void)
961 if (!boot_ec || test_bit(EC_FLAGS_HANDLERS_INSTALLED, &boot_ec->flags))
962 return 0;
963 if (!ec_install_handlers(boot_ec)) {
964 first_ec = boot_ec;
965 return 0;
967 return -EFAULT;
970 static const struct acpi_device_id ec_device_ids[] = {
971 {"PNP0C09", 0},
972 {"", 0},
975 int __init acpi_ec_ecdt_probe(void)
977 acpi_status status;
978 struct acpi_ec *saved_ec = NULL;
979 struct acpi_table_ecdt *ecdt_ptr;
981 boot_ec = make_acpi_ec();
982 if (!boot_ec)
983 return -ENOMEM;
985 * Generate a boot ec context
987 if (dmi_name_in_vendors("Micro-Star") ||
988 dmi_name_in_vendors("Notebook")) {
989 pr_info(PREFIX "Enabling special treatment for EC from MSI.\n");
990 EC_FLAGS_MSI = 1;
992 status = acpi_get_table(ACPI_SIG_ECDT, 1,
993 (struct acpi_table_header **)&ecdt_ptr);
994 if (ACPI_SUCCESS(status)) {
995 pr_info(PREFIX "EC description table is found, configuring boot EC\n");
996 boot_ec->command_addr = ecdt_ptr->control.address;
997 boot_ec->data_addr = ecdt_ptr->data.address;
998 boot_ec->gpe = ecdt_ptr->gpe;
999 boot_ec->handle = ACPI_ROOT_OBJECT;
1000 acpi_get_handle(ACPI_ROOT_OBJECT, ecdt_ptr->id, &boot_ec->handle);
1001 /* Don't trust ECDT, which comes from ASUSTek */
1002 if (!dmi_name_in_vendors("ASUS"))
1003 goto install;
1004 saved_ec = kmalloc(sizeof(struct acpi_ec), GFP_KERNEL);
1005 if (!saved_ec)
1006 return -ENOMEM;
1007 memcpy(saved_ec, boot_ec, sizeof(*saved_ec));
1008 /* fall through */
1010 /* This workaround is needed only on some broken machines,
1011 * which require early EC, but fail to provide ECDT */
1012 printk(KERN_DEBUG PREFIX "Look up EC in DSDT\n");
1013 status = acpi_get_devices(ec_device_ids[0].id, ec_parse_device,
1014 boot_ec, NULL);
1015 /* Check that acpi_get_devices actually find something */
1016 if (ACPI_FAILURE(status) || !boot_ec->handle)
1017 goto error;
1018 if (saved_ec) {
1019 /* try to find good ECDT from ASUSTek */
1020 if (saved_ec->command_addr != boot_ec->command_addr ||
1021 saved_ec->data_addr != boot_ec->data_addr ||
1022 saved_ec->gpe != boot_ec->gpe ||
1023 saved_ec->handle != boot_ec->handle)
1024 pr_info(PREFIX "ASUSTek keeps feeding us with broken "
1025 "ECDT tables, which are very hard to workaround. "
1026 "Trying to use DSDT EC info instead. Please send "
1027 "output of acpidump to linux-acpi@vger.kernel.org\n");
1028 kfree(saved_ec);
1029 saved_ec = NULL;
1030 } else {
1031 /* We really need to limit this workaround, the only ASUS,
1032 * which needs it, has fake EC._INI method, so use it as flag.
1033 * Keep boot_ec struct as it will be needed soon.
1035 acpi_handle dummy;
1036 if (!dmi_name_in_vendors("ASUS") ||
1037 ACPI_FAILURE(acpi_get_handle(boot_ec->handle, "_INI",
1038 &dummy)))
1039 return -ENODEV;
1041 install:
1042 if (!ec_install_handlers(boot_ec)) {
1043 first_ec = boot_ec;
1044 return 0;
1046 error:
1047 kfree(boot_ec);
1048 boot_ec = NULL;
1049 return -ENODEV;
1052 static int acpi_ec_suspend(struct acpi_device *device, pm_message_t state)
1054 struct acpi_ec *ec = acpi_driver_data(device);
1055 /* Stop using GPE */
1056 set_bit(EC_FLAGS_NO_GPE, &ec->flags);
1057 clear_bit(EC_FLAGS_GPE_MODE, &ec->flags);
1058 acpi_disable_gpe(NULL, ec->gpe);
1059 return 0;
1062 static int acpi_ec_resume(struct acpi_device *device)
1064 struct acpi_ec *ec = acpi_driver_data(device);
1065 /* Enable use of GPE back */
1066 clear_bit(EC_FLAGS_NO_GPE, &ec->flags);
1067 acpi_enable_gpe(NULL, ec->gpe);
1068 return 0;
1071 static struct acpi_driver acpi_ec_driver = {
1072 .name = "ec",
1073 .class = ACPI_EC_CLASS,
1074 .ids = ec_device_ids,
1075 .ops = {
1076 .add = acpi_ec_add,
1077 .remove = acpi_ec_remove,
1078 .start = acpi_ec_start,
1079 .stop = acpi_ec_stop,
1080 .suspend = acpi_ec_suspend,
1081 .resume = acpi_ec_resume,
1085 static int __init acpi_ec_init(void)
1087 int result = 0;
1089 if (acpi_disabled)
1090 return 0;
1092 acpi_ec_dir = proc_mkdir(ACPI_EC_CLASS, acpi_root_dir);
1093 if (!acpi_ec_dir)
1094 return -ENODEV;
1096 /* Now register the driver for the EC */
1097 result = acpi_bus_register_driver(&acpi_ec_driver);
1098 if (result < 0) {
1099 remove_proc_entry(ACPI_EC_CLASS, acpi_root_dir);
1100 return -ENODEV;
1103 return result;
1106 subsys_initcall(acpi_ec_init);
1108 /* EC driver currently not unloadable */
1109 #if 0
1110 static void __exit acpi_ec_exit(void)
1113 acpi_bus_unregister_driver(&acpi_ec_driver);
1115 remove_proc_entry(ACPI_EC_CLASS, acpi_root_dir);
1117 return;
1119 #endif /* 0 */