diff options
Diffstat (limited to 'drivers/acpi/ec.c')
| -rw-r--r-- | drivers/acpi/ec.c | 1096 |
1 files changed, 293 insertions, 803 deletions
diff --git a/drivers/acpi/ec.c b/drivers/acpi/ec.c index e5d796362854..e6d4b084dca2 100644 --- a/drivers/acpi/ec.c +++ b/drivers/acpi/ec.c | |||
| @@ -45,206 +45,143 @@ ACPI_MODULE_NAME("acpi_ec") | |||
| 45 | #define ACPI_EC_DRIVER_NAME "ACPI Embedded Controller Driver" | 45 | #define ACPI_EC_DRIVER_NAME "ACPI Embedded Controller Driver" |
| 46 | #define ACPI_EC_DEVICE_NAME "Embedded Controller" | 46 | #define ACPI_EC_DEVICE_NAME "Embedded Controller" |
| 47 | #define ACPI_EC_FILE_INFO "info" | 47 | #define ACPI_EC_FILE_INFO "info" |
| 48 | |||
| 49 | /* EC status register */ | ||
| 48 | #define ACPI_EC_FLAG_OBF 0x01 /* Output buffer full */ | 50 | #define ACPI_EC_FLAG_OBF 0x01 /* Output buffer full */ |
| 49 | #define ACPI_EC_FLAG_IBF 0x02 /* Input buffer full */ | 51 | #define ACPI_EC_FLAG_IBF 0x02 /* Input buffer full */ |
| 50 | #define ACPI_EC_FLAG_BURST 0x10 /* burst mode */ | 52 | #define ACPI_EC_FLAG_BURST 0x10 /* burst mode */ |
| 51 | #define ACPI_EC_FLAG_SCI 0x20 /* EC-SCI occurred */ | 53 | #define ACPI_EC_FLAG_SCI 0x20 /* EC-SCI occurred */ |
| 52 | #define ACPI_EC_EVENT_OBF 0x01 /* Output buffer full */ | 54 | |
| 53 | #define ACPI_EC_EVENT_IBE 0x02 /* Input buffer empty */ | 55 | /* EC commands */ |
| 54 | #define ACPI_EC_DELAY 50 /* Wait 50ms max. during EC ops */ | ||
| 55 | #define ACPI_EC_UDELAY_GLK 1000 /* Wait 1ms max. to get global lock */ | ||
| 56 | #define ACPI_EC_UDELAY 100 /* Poll @ 100us increments */ | ||
| 57 | #define ACPI_EC_UDELAY_COUNT 1000 /* Wait 10ms max. during EC ops */ | ||
| 58 | #define ACPI_EC_COMMAND_READ 0x80 | 56 | #define ACPI_EC_COMMAND_READ 0x80 |
| 59 | #define ACPI_EC_COMMAND_WRITE 0x81 | 57 | #define ACPI_EC_COMMAND_WRITE 0x81 |
| 60 | #define ACPI_EC_BURST_ENABLE 0x82 | 58 | #define ACPI_EC_BURST_ENABLE 0x82 |
| 61 | #define ACPI_EC_BURST_DISABLE 0x83 | 59 | #define ACPI_EC_BURST_DISABLE 0x83 |
| 62 | #define ACPI_EC_COMMAND_QUERY 0x84 | 60 | #define ACPI_EC_COMMAND_QUERY 0x84 |
| 63 | #define EC_POLL 0xFF | 61 | |
| 64 | #define EC_INTR 0x00 | 62 | /* EC events */ |
| 63 | enum { | ||
| 64 | ACPI_EC_EVENT_OBF_1 = 1, /* Output buffer full */ | ||
| 65 | ACPI_EC_EVENT_IBF_0, /* Input buffer empty */ | ||
| 66 | }; | ||
| 67 | |||
| 68 | #define ACPI_EC_DELAY 50 /* Wait 50ms max. during EC ops */ | ||
| 69 | #define ACPI_EC_UDELAY_GLK 1000 /* Wait 1ms max. to get global lock */ | ||
| 70 | #define ACPI_EC_UDELAY 100 /* Poll @ 100us increments */ | ||
| 71 | #define ACPI_EC_UDELAY_COUNT 1000 /* Wait 10ms max. during EC ops */ | ||
| 72 | |||
| 73 | enum { | ||
| 74 | EC_INTR = 1, /* Output buffer full */ | ||
| 75 | EC_POLL, /* Input buffer empty */ | ||
| 76 | }; | ||
| 77 | |||
| 65 | static int acpi_ec_remove(struct acpi_device *device, int type); | 78 | static int acpi_ec_remove(struct acpi_device *device, int type); |
| 66 | static int acpi_ec_start(struct acpi_device *device); | 79 | static int acpi_ec_start(struct acpi_device *device); |
| 67 | static int acpi_ec_stop(struct acpi_device *device, int type); | 80 | static int acpi_ec_stop(struct acpi_device *device, int type); |
| 68 | static int acpi_ec_intr_add(struct acpi_device *device); | 81 | static int acpi_ec_add(struct acpi_device *device); |
| 69 | static int acpi_ec_poll_add(struct acpi_device *device); | ||
| 70 | 82 | ||
| 71 | static struct acpi_driver acpi_ec_driver = { | 83 | static struct acpi_driver acpi_ec_driver = { |
| 72 | .name = ACPI_EC_DRIVER_NAME, | 84 | .name = ACPI_EC_DRIVER_NAME, |
| 73 | .class = ACPI_EC_CLASS, | 85 | .class = ACPI_EC_CLASS, |
| 74 | .ids = ACPI_EC_HID, | 86 | .ids = ACPI_EC_HID, |
| 75 | .ops = { | 87 | .ops = { |
| 76 | .add = acpi_ec_intr_add, | 88 | .add = acpi_ec_add, |
| 77 | .remove = acpi_ec_remove, | 89 | .remove = acpi_ec_remove, |
| 78 | .start = acpi_ec_start, | 90 | .start = acpi_ec_start, |
| 79 | .stop = acpi_ec_stop, | 91 | .stop = acpi_ec_stop, |
| 80 | }, | 92 | }, |
| 81 | }; | 93 | }; |
| 82 | union acpi_ec { | ||
| 83 | struct { | ||
| 84 | u32 mode; | ||
| 85 | acpi_handle handle; | ||
| 86 | unsigned long uid; | ||
| 87 | unsigned long gpe_bit; | ||
| 88 | struct acpi_generic_address status_addr; | ||
| 89 | struct acpi_generic_address command_addr; | ||
| 90 | struct acpi_generic_address data_addr; | ||
| 91 | unsigned long global_lock; | ||
| 92 | } common; | ||
| 93 | |||
| 94 | struct { | ||
| 95 | u32 mode; | ||
| 96 | acpi_handle handle; | ||
| 97 | unsigned long uid; | ||
| 98 | unsigned long gpe_bit; | ||
| 99 | struct acpi_generic_address status_addr; | ||
| 100 | struct acpi_generic_address command_addr; | ||
| 101 | struct acpi_generic_address data_addr; | ||
| 102 | unsigned long global_lock; | ||
| 103 | unsigned int expect_event; | ||
| 104 | atomic_t leaving_burst; /* 0 : No, 1 : Yes, 2: abort */ | ||
| 105 | atomic_t pending_gpe; | ||
| 106 | struct semaphore sem; | ||
| 107 | wait_queue_head_t wait; | ||
| 108 | } intr; | ||
| 109 | |||
| 110 | struct { | ||
| 111 | u32 mode; | ||
| 112 | acpi_handle handle; | ||
| 113 | unsigned long uid; | ||
| 114 | unsigned long gpe_bit; | ||
| 115 | struct acpi_generic_address status_addr; | ||
| 116 | struct acpi_generic_address command_addr; | ||
| 117 | struct acpi_generic_address data_addr; | ||
| 118 | unsigned long global_lock; | ||
| 119 | struct semaphore sem; | ||
| 120 | } poll; | ||
| 121 | }; | ||
| 122 | 94 | ||
| 123 | static int acpi_ec_poll_wait(union acpi_ec *ec, u8 event); | ||
| 124 | static int acpi_ec_intr_wait(union acpi_ec *ec, unsigned int event); | ||
| 125 | static int acpi_ec_poll_read(union acpi_ec *ec, u8 address, u32 * data); | ||
| 126 | static int acpi_ec_intr_read(union acpi_ec *ec, u8 address, u32 * data); | ||
| 127 | static int acpi_ec_poll_write(union acpi_ec *ec, u8 address, u8 data); | ||
| 128 | static int acpi_ec_intr_write(union acpi_ec *ec, u8 address, u8 data); | ||
| 129 | static int acpi_ec_poll_query(union acpi_ec *ec, u32 * data); | ||
| 130 | static int acpi_ec_intr_query(union acpi_ec *ec, u32 * data); | ||
| 131 | static void acpi_ec_gpe_poll_query(void *ec_cxt); | ||
| 132 | static void acpi_ec_gpe_intr_query(void *ec_cxt); | ||
| 133 | static u32 acpi_ec_gpe_poll_handler(void *data); | ||
| 134 | static u32 acpi_ec_gpe_intr_handler(void *data); | ||
| 135 | static acpi_status __init | ||
| 136 | acpi_fake_ecdt_poll_callback(acpi_handle handle, | ||
| 137 | u32 Level, void *context, void **retval); | ||
| 138 | |||
| 139 | static acpi_status __init | ||
| 140 | acpi_fake_ecdt_intr_callback(acpi_handle handle, | ||
| 141 | u32 Level, void *context, void **retval); | ||
| 142 | |||
| 143 | static int __init acpi_ec_poll_get_real_ecdt(void); | ||
| 144 | static int __init acpi_ec_intr_get_real_ecdt(void); | ||
| 145 | /* If we find an EC via the ECDT, we need to keep a ptr to its context */ | 95 | /* If we find an EC via the ECDT, we need to keep a ptr to its context */ |
| 146 | static union acpi_ec *ec_ecdt; | 96 | struct acpi_ec { |
| 97 | acpi_handle handle; | ||
| 98 | unsigned long uid; | ||
| 99 | unsigned long gpe_bit; | ||
| 100 | unsigned long command_addr; | ||
| 101 | unsigned long data_addr; | ||
| 102 | unsigned long global_lock; | ||
| 103 | struct semaphore sem; | ||
| 104 | unsigned int expect_event; | ||
| 105 | atomic_t leaving_burst; /* 0 : No, 1 : Yes, 2: abort */ | ||
| 106 | wait_queue_head_t wait; | ||
| 107 | } *ec_ecdt; | ||
| 147 | 108 | ||
| 148 | /* External interfaces use first EC only, so remember */ | 109 | /* External interfaces use first EC only, so remember */ |
| 149 | static struct acpi_device *first_ec; | 110 | static struct acpi_device *first_ec; |
| 150 | static int acpi_ec_poll_mode = EC_INTR; | 111 | static int acpi_ec_mode = EC_INTR; |
| 151 | 112 | ||
| 152 | /* -------------------------------------------------------------------------- | 113 | /* -------------------------------------------------------------------------- |
| 153 | Transaction Management | 114 | Transaction Management |
| 154 | -------------------------------------------------------------------------- */ | 115 | -------------------------------------------------------------------------- */ |
| 155 | 116 | ||
| 156 | static u32 acpi_ec_read_status(union acpi_ec *ec) | 117 | static inline u8 acpi_ec_read_status(struct acpi_ec *ec) |
| 157 | { | 118 | { |
| 158 | u32 status = 0; | 119 | return inb(ec->command_addr); |
| 159 | |||
| 160 | acpi_hw_low_level_read(8, &status, &ec->common.status_addr); | ||
| 161 | return status; | ||
| 162 | } | 120 | } |
| 163 | 121 | ||
| 164 | static int acpi_ec_wait(union acpi_ec *ec, u8 event) | 122 | static inline u8 acpi_ec_read_data(struct acpi_ec *ec) |
| 165 | { | 123 | { |
| 166 | if (acpi_ec_poll_mode) | 124 | return inb(ec->data_addr); |
| 167 | return acpi_ec_poll_wait(ec, event); | ||
| 168 | else | ||
| 169 | return acpi_ec_intr_wait(ec, event); | ||
| 170 | } | 125 | } |
| 171 | 126 | ||
| 172 | static int acpi_ec_poll_wait(union acpi_ec *ec, u8 event) | 127 | static inline void acpi_ec_write_cmd(struct acpi_ec *ec, u8 command) |
| 173 | { | 128 | { |
| 174 | u32 acpi_ec_status = 0; | 129 | outb(command, ec->command_addr); |
| 175 | u32 i = ACPI_EC_UDELAY_COUNT; | 130 | } |
| 176 | 131 | ||
| 177 | if (!ec) | 132 | static inline void acpi_ec_write_data(struct acpi_ec *ec, u8 data) |
| 178 | return -EINVAL; | 133 | { |
| 134 | outb(data, ec->data_addr); | ||
| 135 | } | ||
| 179 | 136 | ||
| 180 | /* Poll the EC status register waiting for the event to occur. */ | 137 | static int acpi_ec_check_status(u8 status, u8 event) |
| 138 | { | ||
| 181 | switch (event) { | 139 | switch (event) { |
| 182 | case ACPI_EC_EVENT_OBF: | 140 | case ACPI_EC_EVENT_OBF_1: |
| 183 | do { | 141 | if (status & ACPI_EC_FLAG_OBF) |
| 184 | acpi_hw_low_level_read(8, &acpi_ec_status, | 142 | return 1; |
| 185 | &ec->common.status_addr); | ||
| 186 | if (acpi_ec_status & ACPI_EC_FLAG_OBF) | ||
| 187 | return 0; | ||
| 188 | udelay(ACPI_EC_UDELAY); | ||
| 189 | } while (--i > 0); | ||
| 190 | break; | 143 | break; |
| 191 | case ACPI_EC_EVENT_IBE: | 144 | case ACPI_EC_EVENT_IBF_0: |
| 192 | do { | 145 | if (!(status & ACPI_EC_FLAG_IBF)) |
| 193 | acpi_hw_low_level_read(8, &acpi_ec_status, | 146 | return 1; |
| 194 | &ec->common.status_addr); | ||
| 195 | if (!(acpi_ec_status & ACPI_EC_FLAG_IBF)) | ||
| 196 | return 0; | ||
| 197 | udelay(ACPI_EC_UDELAY); | ||
| 198 | } while (--i > 0); | ||
| 199 | break; | 147 | break; |
| 200 | default: | 148 | default: |
| 201 | return -EINVAL; | 149 | break; |
| 202 | } | 150 | } |
| 203 | 151 | ||
| 204 | return -ETIME; | 152 | return 0; |
| 205 | } | 153 | } |
| 206 | static int acpi_ec_intr_wait(union acpi_ec *ec, unsigned int event) | ||
| 207 | { | ||
| 208 | int result = 0; | ||
| 209 | |||
| 210 | 154 | ||
| 211 | ec->intr.expect_event = event; | 155 | static int acpi_ec_wait(struct acpi_ec *ec, u8 event) |
| 212 | smp_mb(); | 156 | { |
| 157 | int i = (acpi_ec_mode == EC_POLL) ? ACPI_EC_UDELAY_COUNT : 0; | ||
| 158 | long time_left; | ||
| 213 | 159 | ||
| 214 | switch (event) { | 160 | ec->expect_event = event; |
| 215 | case ACPI_EC_EVENT_IBE: | 161 | if (acpi_ec_check_status(acpi_ec_read_status(ec), event)) { |
| 216 | if (~acpi_ec_read_status(ec) & ACPI_EC_FLAG_IBF) { | 162 | ec->expect_event = 0; |
| 217 | ec->intr.expect_event = 0; | 163 | return 0; |
| 218 | return 0; | ||
| 219 | } | ||
| 220 | break; | ||
| 221 | default: | ||
| 222 | break; | ||
| 223 | } | 164 | } |
| 224 | 165 | ||
| 225 | result = wait_event_timeout(ec->intr.wait, | 166 | do { |
| 226 | !ec->intr.expect_event, | 167 | if (acpi_ec_mode == EC_POLL) { |
| 168 | udelay(ACPI_EC_UDELAY); | ||
| 169 | } else { | ||
| 170 | time_left = wait_event_timeout(ec->wait, | ||
| 171 | !ec->expect_event, | ||
| 227 | msecs_to_jiffies(ACPI_EC_DELAY)); | 172 | msecs_to_jiffies(ACPI_EC_DELAY)); |
| 228 | 173 | if (time_left > 0) { | |
| 229 | ec->intr.expect_event = 0; | 174 | ec->expect_event = 0; |
| 230 | smp_mb(); | 175 | return 0; |
| 231 | 176 | } | |
| 232 | /* | 177 | } |
| 233 | * Verify that the event in question has actually happened by | 178 | if (acpi_ec_check_status(acpi_ec_read_status(ec), event)) { |
| 234 | * querying EC status. Do the check even if operation timed-out | 179 | ec->expect_event = 0; |
| 235 | * to make sure that we did not miss interrupt. | ||
| 236 | */ | ||
| 237 | switch (event) { | ||
| 238 | case ACPI_EC_EVENT_OBF: | ||
| 239 | if (acpi_ec_read_status(ec) & ACPI_EC_FLAG_OBF) | ||
| 240 | return 0; | 180 | return 0; |
| 241 | break; | 181 | } |
| 182 | } while (--i > 0); | ||
| 242 | 183 | ||
| 243 | case ACPI_EC_EVENT_IBE: | 184 | ec->expect_event = 0; |
| 244 | if (~acpi_ec_read_status(ec) & ACPI_EC_FLAG_IBF) | ||
| 245 | return 0; | ||
| 246 | break; | ||
| 247 | } | ||
| 248 | 185 | ||
| 249 | return -ETIME; | 186 | return -ETIME; |
| 250 | } | 187 | } |
| @@ -254,272 +191,150 @@ static int acpi_ec_intr_wait(union acpi_ec *ec, unsigned int event) | |||
| 254 | * Note: samsung nv5000 doesn't work with ec burst mode. | 191 | * Note: samsung nv5000 doesn't work with ec burst mode. |
| 255 | * http://bugzilla.kernel.org/show_bug.cgi?id=4980 | 192 | * http://bugzilla.kernel.org/show_bug.cgi?id=4980 |
| 256 | */ | 193 | */ |
| 257 | int acpi_ec_enter_burst_mode(union acpi_ec *ec) | 194 | int acpi_ec_enter_burst_mode(struct acpi_ec *ec) |
| 258 | { | 195 | { |
| 259 | u32 tmp = 0; | 196 | u8 tmp = 0; |
| 260 | int status = 0; | 197 | u8 status = 0; |
| 261 | 198 | ||
| 262 | 199 | ||
| 263 | status = acpi_ec_read_status(ec); | 200 | status = acpi_ec_read_status(ec); |
| 264 | if (status != -EINVAL && !(status & ACPI_EC_FLAG_BURST)) { | 201 | if (status != -EINVAL && !(status & ACPI_EC_FLAG_BURST)) { |
| 265 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | 202 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 266 | if (status) | 203 | if (status) |
| 267 | goto end; | 204 | goto end; |
| 268 | acpi_hw_low_level_write(8, ACPI_EC_BURST_ENABLE, | 205 | acpi_ec_write_cmd(ec, ACPI_EC_BURST_ENABLE); |
| 269 | &ec->common.command_addr); | 206 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF_1); |
| 270 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF); | 207 | tmp = acpi_ec_read_data(ec); |
| 271 | acpi_hw_low_level_read(8, &tmp, &ec->common.data_addr); | ||
| 272 | if (tmp != 0x90) { /* Burst ACK byte */ | 208 | if (tmp != 0x90) { /* Burst ACK byte */ |
| 273 | return -EINVAL; | 209 | return -EINVAL; |
| 274 | } | 210 | } |
| 275 | } | 211 | } |
| 276 | 212 | ||
| 277 | atomic_set(&ec->intr.leaving_burst, 0); | 213 | atomic_set(&ec->leaving_burst, 0); |
| 278 | return 0; | 214 | return 0; |
| 279 | end: | 215 | end: |
| 280 | ACPI_EXCEPTION ((AE_INFO, status, "EC wait, burst mode"); | 216 | ACPI_EXCEPTION((AE_INFO, status, "EC wait, burst mode")); |
| 281 | return -1; | 217 | return -1; |
| 282 | } | 218 | } |
| 283 | 219 | ||
| 284 | int acpi_ec_leave_burst_mode(union acpi_ec *ec) | 220 | int acpi_ec_leave_burst_mode(struct acpi_ec *ec) |
| 285 | { | 221 | { |
| 286 | int status = 0; | 222 | u8 status = 0; |
| 287 | 223 | ||
| 288 | 224 | ||
| 289 | status = acpi_ec_read_status(ec); | 225 | status = acpi_ec_read_status(ec); |
| 290 | if (status != -EINVAL && (status & ACPI_EC_FLAG_BURST)){ | 226 | if (status != -EINVAL && (status & ACPI_EC_FLAG_BURST)){ |
| 291 | status = acpi_ec_wait(ec, ACPI_EC_FLAG_IBF); | 227 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 292 | if(status) | 228 | if(status) |
| 293 | goto end; | 229 | goto end; |
| 294 | acpi_hw_low_level_write(8, ACPI_EC_BURST_DISABLE, &ec->common.command_addr); | 230 | acpi_ec_write_cmd(ec, ACPI_EC_BURST_DISABLE); |
| 295 | acpi_ec_wait(ec, ACPI_EC_FLAG_IBF); | 231 | acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 296 | } | 232 | } |
| 297 | atomic_set(&ec->intr.leaving_burst, 1); | 233 | atomic_set(&ec->leaving_burst, 1); |
| 298 | return 0; | 234 | return 0; |
| 299 | end: | 235 | end: |
| 300 | ACPI_EXCEPTION((AE_INFO, status, "EC leave burst mode"); | 236 | ACPI_EXCEPTION((AE_INFO, status, "EC leave burst mode")); |
| 301 | return -1; | 237 | return -1; |
| 302 | } | 238 | } |
| 303 | #endif /* ACPI_FUTURE_USAGE */ | 239 | #endif /* ACPI_FUTURE_USAGE */ |
| 304 | 240 | ||
| 305 | static int acpi_ec_read(union acpi_ec *ec, u8 address, u32 * data) | 241 | static int acpi_ec_transaction_unlocked(struct acpi_ec *ec, u8 command, |
| 306 | { | 242 | const u8 *wdata, unsigned wdata_len, |
| 307 | if (acpi_ec_poll_mode) | 243 | u8 *rdata, unsigned rdata_len) |
| 308 | return acpi_ec_poll_read(ec, address, data); | ||
| 309 | else | ||
| 310 | return acpi_ec_intr_read(ec, address, data); | ||
| 311 | } | ||
| 312 | static int acpi_ec_write(union acpi_ec *ec, u8 address, u8 data) | ||
| 313 | { | ||
| 314 | if (acpi_ec_poll_mode) | ||
| 315 | return acpi_ec_poll_write(ec, address, data); | ||
| 316 | else | ||
| 317 | return acpi_ec_intr_write(ec, address, data); | ||
| 318 | } | ||
| 319 | static int acpi_ec_poll_read(union acpi_ec *ec, u8 address, u32 * data) | ||
| 320 | { | 244 | { |
| 321 | acpi_status status = AE_OK; | 245 | int result; |
| 322 | int result = 0; | ||
| 323 | u32 glk = 0; | ||
| 324 | 246 | ||
| 247 | acpi_ec_write_cmd(ec, command); | ||
| 325 | 248 | ||
| 326 | if (!ec || !data) | 249 | for (; wdata_len > 0; wdata_len --) { |
| 327 | return -EINVAL; | 250 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 328 | 251 | if (result) | |
| 329 | *data = 0; | 252 | return result; |
| 330 | 253 | acpi_ec_write_data(ec, *(wdata++)); | |
| 331 | if (ec->common.global_lock) { | ||
| 332 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | ||
| 333 | if (ACPI_FAILURE(status)) | ||
| 334 | return -ENODEV; | ||
| 335 | } | 254 | } |
| 336 | 255 | ||
| 337 | if (down_interruptible(&ec->poll.sem)) { | 256 | if (command == ACPI_EC_COMMAND_WRITE) { |
| 338 | result = -ERESTARTSYS; | 257 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 339 | goto end_nosem; | 258 | if (result) |
| 259 | return result; | ||
| 340 | } | 260 | } |
| 341 | |||
| 342 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_READ, | ||
| 343 | &ec->common.command_addr); | ||
| 344 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 345 | if (result) | ||
| 346 | goto end; | ||
| 347 | |||
| 348 | acpi_hw_low_level_write(8, address, &ec->common.data_addr); | ||
| 349 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF); | ||
| 350 | if (result) | ||
| 351 | goto end; | ||
| 352 | |||
| 353 | acpi_hw_low_level_read(8, data, &ec->common.data_addr); | ||
| 354 | |||
| 355 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Read [%02x] from address [%02x]\n", | ||
| 356 | *data, address)); | ||
| 357 | |||
| 358 | end: | ||
| 359 | up(&ec->poll.sem); | ||
| 360 | end_nosem: | ||
| 361 | if (ec->common.global_lock) | ||
| 362 | acpi_release_global_lock(glk); | ||
| 363 | |||
| 364 | return result; | ||
| 365 | } | ||
| 366 | |||
| 367 | static int acpi_ec_poll_write(union acpi_ec *ec, u8 address, u8 data) | ||
| 368 | { | ||
| 369 | int result = 0; | ||
| 370 | acpi_status status = AE_OK; | ||
| 371 | u32 glk = 0; | ||
| 372 | 261 | ||
| 262 | for (; rdata_len > 0; rdata_len --) { | ||
| 263 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF_1); | ||
| 264 | if (result) | ||
| 265 | return result; | ||
| 373 | 266 | ||
| 374 | if (!ec) | 267 | *(rdata++) = acpi_ec_read_data(ec); |
| 375 | return -EINVAL; | ||
| 376 | |||
| 377 | if (ec->common.global_lock) { | ||
| 378 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | ||
| 379 | if (ACPI_FAILURE(status)) | ||
| 380 | return -ENODEV; | ||
| 381 | } | ||
| 382 | |||
| 383 | if (down_interruptible(&ec->poll.sem)) { | ||
| 384 | result = -ERESTARTSYS; | ||
| 385 | goto end_nosem; | ||
| 386 | } | 268 | } |
| 387 | |||
| 388 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_WRITE, | ||
| 389 | &ec->common.command_addr); | ||
| 390 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 391 | if (result) | ||
| 392 | goto end; | ||
| 393 | |||
| 394 | acpi_hw_low_level_write(8, address, &ec->common.data_addr); | ||
| 395 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 396 | if (result) | ||
| 397 | goto end; | ||
| 398 | |||
| 399 | acpi_hw_low_level_write(8, data, &ec->common.data_addr); | ||
| 400 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 401 | if (result) | ||
| 402 | goto end; | ||
| 403 | 269 | ||
| 404 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Wrote [%02x] to address [%02x]\n", | 270 | return 0; |
| 405 | data, address)); | ||
| 406 | |||
| 407 | end: | ||
| 408 | up(&ec->poll.sem); | ||
| 409 | end_nosem: | ||
| 410 | if (ec->common.global_lock) | ||
| 411 | acpi_release_global_lock(glk); | ||
| 412 | |||
| 413 | return result; | ||
| 414 | } | 271 | } |
| 415 | 272 | ||
| 416 | static int acpi_ec_intr_read(union acpi_ec *ec, u8 address, u32 * data) | 273 | static int acpi_ec_transaction(struct acpi_ec *ec, u8 command, |
| 274 | const u8 *wdata, unsigned wdata_len, | ||
| 275 | u8 *rdata, unsigned rdata_len) | ||
| 417 | { | 276 | { |
| 418 | int status = 0; | 277 | int status; |
| 419 | u32 glk; | 278 | u32 glk; |
| 420 | 279 | ||
| 421 | 280 | if (!ec || (wdata_len && !wdata) || (rdata_len && !rdata)) | |
| 422 | if (!ec || !data) | ||
| 423 | return -EINVAL; | 281 | return -EINVAL; |
| 424 | 282 | ||
| 425 | *data = 0; | 283 | if (rdata) |
| 284 | memset(rdata, 0, rdata_len); | ||
| 426 | 285 | ||
| 427 | if (ec->common.global_lock) { | 286 | if (ec->global_lock) { |
| 428 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | 287 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); |
| 429 | if (ACPI_FAILURE(status)) | 288 | if (ACPI_FAILURE(status)) |
| 430 | return -ENODEV; | 289 | return -ENODEV; |
| 431 | } | 290 | } |
| 291 | down(&ec->sem); | ||
| 432 | 292 | ||
| 433 | WARN_ON(in_interrupt()); | 293 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0); |
| 434 | down(&ec->intr.sem); | ||
| 435 | |||
| 436 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 437 | if (status) { | 294 | if (status) { |
| 438 | printk(KERN_DEBUG PREFIX "read EC, IB not empty\n"); | 295 | printk(KERN_DEBUG PREFIX "read EC, IB not empty\n"); |
| 439 | goto end; | 296 | goto end; |
| 440 | } | 297 | } |
| 441 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_READ, | ||
| 442 | &ec->common.command_addr); | ||
| 443 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 444 | if (status) { | ||
| 445 | printk(KERN_DEBUG PREFIX "read EC, IB not empty\n"); | ||
| 446 | } | ||
| 447 | 298 | ||
| 448 | acpi_hw_low_level_write(8, address, &ec->common.data_addr); | 299 | status = acpi_ec_transaction_unlocked(ec, command, |
| 449 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF); | 300 | wdata, wdata_len, |
| 450 | if (status) { | 301 | rdata, rdata_len); |
| 451 | printk(KERN_DEBUG PREFIX "read EC, OB not full\n"); | ||
| 452 | goto end; | ||
| 453 | } | ||
| 454 | acpi_hw_low_level_read(8, data, &ec->common.data_addr); | ||
| 455 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Read [%02x] from address [%02x]\n", | ||
| 456 | *data, address)); | ||
| 457 | 302 | ||
| 458 | end: | 303 | end: |
| 459 | up(&ec->intr.sem); | 304 | up(&ec->sem); |
| 460 | 305 | ||
| 461 | if (ec->common.global_lock) | 306 | if (ec->global_lock) |
| 462 | acpi_release_global_lock(glk); | 307 | acpi_release_global_lock(glk); |
| 463 | 308 | ||
| 464 | return status; | 309 | return status; |
| 465 | } | 310 | } |
| 466 | 311 | ||
| 467 | static int acpi_ec_intr_write(union acpi_ec *ec, u8 address, u8 data) | 312 | static int acpi_ec_read(struct acpi_ec *ec, u8 address, u8 *data) |
| 468 | { | 313 | { |
| 469 | int status = 0; | 314 | int result; |
| 470 | u32 glk; | 315 | u8 d; |
| 471 | |||
| 472 | |||
| 473 | if (!ec) | ||
| 474 | return -EINVAL; | ||
| 475 | |||
| 476 | if (ec->common.global_lock) { | ||
| 477 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | ||
| 478 | if (ACPI_FAILURE(status)) | ||
| 479 | return -ENODEV; | ||
| 480 | } | ||
| 481 | |||
| 482 | WARN_ON(in_interrupt()); | ||
| 483 | down(&ec->intr.sem); | ||
| 484 | |||
| 485 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 486 | if (status) { | ||
| 487 | printk(KERN_DEBUG PREFIX "write EC, IB not empty\n"); | ||
| 488 | } | ||
| 489 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_WRITE, | ||
| 490 | &ec->common.command_addr); | ||
| 491 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 492 | if (status) { | ||
| 493 | printk(KERN_DEBUG PREFIX "write EC, IB not empty\n"); | ||
| 494 | } | ||
| 495 | |||
| 496 | acpi_hw_low_level_write(8, address, &ec->common.data_addr); | ||
| 497 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | ||
| 498 | if (status) { | ||
| 499 | printk(KERN_DEBUG PREFIX "write EC, IB not empty\n"); | ||
| 500 | } | ||
| 501 | |||
| 502 | acpi_hw_low_level_write(8, data, &ec->common.data_addr); | ||
| 503 | 316 | ||
| 504 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Wrote [%02x] to address [%02x]\n", | 317 | result = acpi_ec_transaction(ec, ACPI_EC_COMMAND_READ, |
| 505 | data, address)); | 318 | &address, 1, &d, 1); |
| 506 | 319 | *data = d; | |
| 507 | up(&ec->intr.sem); | 320 | return result; |
| 508 | 321 | } | |
| 509 | if (ec->common.global_lock) | ||
| 510 | acpi_release_global_lock(glk); | ||
| 511 | 322 | ||
| 512 | return status; | 323 | static int acpi_ec_write(struct acpi_ec *ec, u8 address, u8 data) |
| 324 | { | ||
| 325 | u8 wdata[2] = { address, data }; | ||
| 326 | return acpi_ec_transaction(ec, ACPI_EC_COMMAND_WRITE, | ||
| 327 | wdata, 2, NULL, 0); | ||
| 513 | } | 328 | } |
| 514 | 329 | ||
| 515 | /* | 330 | /* |
| 516 | * Externally callable EC access functions. For now, assume 1 EC only | 331 | * Externally callable EC access functions. For now, assume 1 EC only |
| 517 | */ | 332 | */ |
| 518 | int ec_read(u8 addr, u8 * val) | 333 | int ec_read(u8 addr, u8 *val) |
| 519 | { | 334 | { |
| 520 | union acpi_ec *ec; | 335 | struct acpi_ec *ec; |
| 521 | int err; | 336 | int err; |
| 522 | u32 temp_data; | 337 | u8 temp_data; |
| 523 | 338 | ||
| 524 | if (!first_ec) | 339 | if (!first_ec) |
| 525 | return -ENODEV; | 340 | return -ENODEV; |
| @@ -539,7 +354,7 @@ EXPORT_SYMBOL(ec_read); | |||
| 539 | 354 | ||
| 540 | int ec_write(u8 addr, u8 val) | 355 | int ec_write(u8 addr, u8 val) |
| 541 | { | 356 | { |
| 542 | union acpi_ec *ec; | 357 | struct acpi_ec *ec; |
| 543 | int err; | 358 | int err; |
| 544 | 359 | ||
| 545 | if (!first_ec) | 360 | if (!first_ec) |
| @@ -554,255 +369,106 @@ int ec_write(u8 addr, u8 val) | |||
| 554 | 369 | ||
| 555 | EXPORT_SYMBOL(ec_write); | 370 | EXPORT_SYMBOL(ec_write); |
| 556 | 371 | ||
| 557 | static int acpi_ec_query(union acpi_ec *ec, u32 * data) | 372 | extern int ec_transaction(u8 command, |
| 558 | { | 373 | const u8 *wdata, unsigned wdata_len, |
| 559 | if (acpi_ec_poll_mode) | 374 | u8 *rdata, unsigned rdata_len) |
| 560 | return acpi_ec_poll_query(ec, data); | ||
| 561 | else | ||
| 562 | return acpi_ec_intr_query(ec, data); | ||
| 563 | } | ||
| 564 | static int acpi_ec_poll_query(union acpi_ec *ec, u32 * data) | ||
| 565 | { | 375 | { |
| 566 | int result = 0; | 376 | struct acpi_ec *ec; |
| 567 | acpi_status status = AE_OK; | ||
| 568 | u32 glk = 0; | ||
| 569 | |||
| 570 | |||
| 571 | if (!ec || !data) | ||
| 572 | return -EINVAL; | ||
| 573 | |||
| 574 | *data = 0; | ||
| 575 | |||
| 576 | if (ec->common.global_lock) { | ||
| 577 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | ||
| 578 | if (ACPI_FAILURE(status)) | ||
| 579 | return -ENODEV; | ||
| 580 | } | ||
| 581 | 377 | ||
| 582 | /* | 378 | if (!first_ec) |
| 583 | * Query the EC to find out which _Qxx method we need to evaluate. | 379 | return -ENODEV; |
| 584 | * Note that successful completion of the query causes the ACPI_EC_SCI | ||
| 585 | * bit to be cleared (and thus clearing the interrupt source). | ||
| 586 | */ | ||
| 587 | if (down_interruptible(&ec->poll.sem)) { | ||
| 588 | result = -ERESTARTSYS; | ||
| 589 | goto end_nosem; | ||
| 590 | } | ||
| 591 | |||
| 592 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_QUERY, | ||
| 593 | &ec->common.command_addr); | ||
| 594 | result = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF); | ||
| 595 | if (result) | ||
| 596 | goto end; | ||
| 597 | |||
| 598 | acpi_hw_low_level_read(8, data, &ec->common.data_addr); | ||
| 599 | if (!*data) | ||
| 600 | result = -ENODATA; | ||
| 601 | 380 | ||
| 602 | end: | 381 | ec = acpi_driver_data(first_ec); |
| 603 | up(&ec->poll.sem); | ||
| 604 | end_nosem: | ||
| 605 | if (ec->common.global_lock) | ||
| 606 | acpi_release_global_lock(glk); | ||
| 607 | 382 | ||
| 608 | return result; | 383 | return acpi_ec_transaction(ec, command, wdata, |
| 384 | wdata_len, rdata, rdata_len); | ||
| 609 | } | 385 | } |
| 610 | static int acpi_ec_intr_query(union acpi_ec *ec, u32 * data) | ||
| 611 | { | ||
| 612 | int status = 0; | ||
| 613 | u32 glk; | ||
| 614 | |||
| 615 | 386 | ||
| 616 | if (!ec || !data) | 387 | EXPORT_SYMBOL(ec_transaction); |
| 617 | return -EINVAL; | ||
| 618 | *data = 0; | ||
| 619 | |||
| 620 | if (ec->common.global_lock) { | ||
| 621 | status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk); | ||
| 622 | if (ACPI_FAILURE(status)) | ||
| 623 | return -ENODEV; | ||
| 624 | } | ||
| 625 | 388 | ||
| 626 | down(&ec->intr.sem); | 389 | static int acpi_ec_query(struct acpi_ec *ec, u8 *data) |
| 390 | { | ||
| 391 | int result; | ||
| 392 | u8 d; | ||
| 627 | 393 | ||
| 628 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBE); | 394 | if (!ec || !data) |
| 629 | if (status) { | 395 | return -EINVAL; |
| 630 | printk(KERN_DEBUG PREFIX "query EC, IB not empty\n"); | ||
| 631 | goto end; | ||
| 632 | } | ||
| 633 | /* | ||
| 634 | * Query the EC to find out which _Qxx method we need to evaluate. | ||
| 635 | * Note that successful completion of the query causes the ACPI_EC_SCI | ||
| 636 | * bit to be cleared (and thus clearing the interrupt source). | ||
| 637 | */ | ||
| 638 | acpi_hw_low_level_write(8, ACPI_EC_COMMAND_QUERY, | ||
| 639 | &ec->common.command_addr); | ||
| 640 | status = acpi_ec_wait(ec, ACPI_EC_EVENT_OBF); | ||
| 641 | if (status) { | ||
| 642 | printk(KERN_DEBUG PREFIX "query EC, OB not full\n"); | ||
| 643 | goto end; | ||
| 644 | } | ||
| 645 | 396 | ||
| 646 | acpi_hw_low_level_read(8, data, &ec->common.data_addr); | 397 | /* |
| 647 | if (!*data) | 398 | * Query the EC to find out which _Qxx method we need to evaluate. |
| 648 | status = -ENODATA; | 399 | * Note that successful completion of the query causes the ACPI_EC_SCI |
| 400 | * bit to be cleared (and thus clearing the interrupt source). | ||
| 401 | */ | ||
| 649 | 402 | ||
| 650 | end: | 403 | result = acpi_ec_transaction(ec, ACPI_EC_COMMAND_QUERY, NULL, 0, &d, 1); |
| 651 | up(&ec->intr.sem); | 404 | if (result) |
| 405 | return result; | ||
| 652 | 406 | ||
| 653 | if (ec->common.global_lock) | 407 | if (!d) |
| 654 | acpi_release_global_lock(glk); | 408 | return -ENODATA; |
| 655 | 409 | ||
| 656 | return status; | 410 | *data = d; |
| 411 | return 0; | ||
| 657 | } | 412 | } |
| 658 | 413 | ||
| 659 | /* -------------------------------------------------------------------------- | 414 | /* -------------------------------------------------------------------------- |
| 660 | Event Management | 415 | Event Management |
| 661 | -------------------------------------------------------------------------- */ | 416 | -------------------------------------------------------------------------- */ |
| 662 | 417 | ||
| 663 | union acpi_ec_query_data { | 418 | struct acpi_ec_query_data { |
| 664 | acpi_handle handle; | 419 | acpi_handle handle; |
| 665 | u8 data; | 420 | u8 data; |
| 666 | }; | 421 | }; |
| 667 | 422 | ||
| 668 | static void acpi_ec_gpe_query(void *ec_cxt) | 423 | static void acpi_ec_gpe_query(void *ec_cxt) |
| 669 | { | 424 | { |
| 670 | if (acpi_ec_poll_mode) | 425 | struct acpi_ec *ec = (struct acpi_ec *)ec_cxt; |
| 671 | acpi_ec_gpe_poll_query(ec_cxt); | 426 | u8 value = 0; |
| 672 | else | 427 | static char object_name[8]; |
| 673 | acpi_ec_gpe_intr_query(ec_cxt); | ||
| 674 | } | ||
| 675 | |||
| 676 | static void acpi_ec_gpe_poll_query(void *ec_cxt) | ||
| 677 | { | ||
| 678 | union acpi_ec *ec = (union acpi_ec *)ec_cxt; | ||
| 679 | u32 value = 0; | ||
| 680 | static char object_name[5] = { '_', 'Q', '0', '0', '\0' }; | ||
| 681 | const char hex[] = { '0', '1', '2', '3', '4', '5', '6', '7', | ||
| 682 | '8', '9', 'A', 'B', 'C', 'D', 'E', 'F' | ||
| 683 | }; | ||
| 684 | |||
| 685 | 428 | ||
| 686 | if (!ec_cxt) | 429 | if (!ec) |
| 687 | goto end; | 430 | goto end; |
| 688 | 431 | ||
| 689 | if (down_interruptible (&ec->poll.sem)) { | 432 | value = acpi_ec_read_status(ec); |
| 690 | return; | 433 | |
| 691 | } | ||
| 692 | acpi_hw_low_level_read(8, &value, &ec->common.command_addr); | ||
| 693 | up(&ec->poll.sem); | ||
| 694 | |||
| 695 | /* TBD: Implement asynch events! | ||
| 696 | * NOTE: All we care about are EC-SCI's. Other EC events are | ||
| 697 | * handled via polling (yuck!). This is because some systems | ||
| 698 | * treat EC-SCIs as level (versus EDGE!) triggered, preventing | ||
| 699 | * a purely interrupt-driven approach (grumble, grumble). | ||
| 700 | */ | ||
| 701 | if (!(value & ACPI_EC_FLAG_SCI)) | 434 | if (!(value & ACPI_EC_FLAG_SCI)) |
| 702 | goto end; | 435 | goto end; |
| 703 | 436 | ||
| 704 | if (acpi_ec_query(ec, &value)) | 437 | if (acpi_ec_query(ec, &value)) |
| 705 | goto end; | 438 | goto end; |
| 706 | 439 | ||
| 707 | object_name[2] = hex[((value >> 4) & 0x0F)]; | 440 | snprintf(object_name, 8, "_Q%2.2X", value); |
| 708 | object_name[3] = hex[(value & 0x0F)]; | ||
| 709 | |||
| 710 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Evaluating %s\n", object_name)); | ||
| 711 | 441 | ||
| 712 | acpi_evaluate_object(ec->common.handle, object_name, NULL, NULL); | 442 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Evaluating %s", object_name)); |
| 713 | 443 | ||
| 714 | end: | 444 | acpi_evaluate_object(ec->handle, object_name, NULL, NULL); |
| 715 | acpi_enable_gpe(NULL, ec->common.gpe_bit, ACPI_NOT_ISR); | ||
| 716 | } | ||
| 717 | static void acpi_ec_gpe_intr_query(void *ec_cxt) | ||
| 718 | { | ||
| 719 | union acpi_ec *ec = (union acpi_ec *)ec_cxt; | ||
| 720 | u32 value; | ||
| 721 | int result = -ENODATA; | ||
| 722 | static char object_name[5] = { '_', 'Q', '0', '0', '\0' }; | ||
| 723 | const char hex[] = { '0', '1', '2', '3', '4', '5', '6', '7', | ||
| 724 | '8', '9', 'A', 'B', 'C', 'D', 'E', 'F' | ||
| 725 | }; | ||
| 726 | 445 | ||
| 727 | |||
| 728 | if (acpi_ec_read_status(ec) & ACPI_EC_FLAG_SCI) | ||
| 729 | result = acpi_ec_query(ec, &value); | ||
| 730 | |||
| 731 | if (result) | ||
| 732 | goto end; | ||
| 733 | |||
| 734 | object_name[2] = hex[((value >> 4) & 0x0F)]; | ||
| 735 | object_name[3] = hex[(value & 0x0F)]; | ||
| 736 | |||
| 737 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Evaluating %s\n", object_name)); | ||
| 738 | |||
| 739 | acpi_evaluate_object(ec->common.handle, object_name, NULL, NULL); | ||
| 740 | end: | 446 | end: |
| 741 | atomic_dec(&ec->intr.pending_gpe); | 447 | acpi_enable_gpe(NULL, ec->gpe_bit, ACPI_NOT_ISR); |
| 742 | return; | ||
| 743 | } | 448 | } |
| 744 | 449 | ||
| 745 | static u32 acpi_ec_gpe_handler(void *data) | 450 | static u32 acpi_ec_gpe_handler(void *data) |
| 746 | { | 451 | { |
| 747 | if (acpi_ec_poll_mode) | ||
| 748 | return acpi_ec_gpe_poll_handler(data); | ||
| 749 | else | ||
| 750 | return acpi_ec_gpe_intr_handler(data); | ||
| 751 | } | ||
| 752 | static u32 acpi_ec_gpe_poll_handler(void *data) | ||
| 753 | { | ||
| 754 | acpi_status status = AE_OK; | 452 | acpi_status status = AE_OK; |
| 755 | union acpi_ec *ec = (union acpi_ec *)data; | 453 | u8 value; |
| 756 | 454 | struct acpi_ec *ec = (struct acpi_ec *)data; | |
| 757 | if (!ec) | ||
| 758 | return ACPI_INTERRUPT_NOT_HANDLED; | ||
| 759 | |||
| 760 | acpi_disable_gpe(NULL, ec->common.gpe_bit, ACPI_ISR); | ||
| 761 | |||
| 762 | status = acpi_os_execute(OSL_EC_POLL_HANDLER, acpi_ec_gpe_query, ec); | ||
| 763 | |||
| 764 | if (status == AE_OK) | ||
| 765 | return ACPI_INTERRUPT_HANDLED; | ||
| 766 | else | ||
| 767 | return ACPI_INTERRUPT_NOT_HANDLED; | ||
| 768 | } | ||
| 769 | static u32 acpi_ec_gpe_intr_handler(void *data) | ||
| 770 | { | ||
| 771 | acpi_status status = AE_OK; | ||
| 772 | u32 value; | ||
| 773 | union acpi_ec *ec = (union acpi_ec *)data; | ||
| 774 | |||
| 775 | if (!ec) | ||
| 776 | return ACPI_INTERRUPT_NOT_HANDLED; | ||
| 777 | 455 | ||
| 778 | acpi_clear_gpe(NULL, ec->common.gpe_bit, ACPI_ISR); | 456 | acpi_clear_gpe(NULL, ec->gpe_bit, ACPI_ISR); |
| 779 | value = acpi_ec_read_status(ec); | 457 | value = acpi_ec_read_status(ec); |
| 780 | 458 | ||
| 781 | switch (ec->intr.expect_event) { | 459 | if (acpi_ec_mode == EC_INTR) { |
| 782 | case ACPI_EC_EVENT_OBF: | 460 | if (acpi_ec_check_status(value, ec->expect_event)) { |
| 783 | if (!(value & ACPI_EC_FLAG_OBF)) | 461 | ec->expect_event = 0; |
| 784 | break; | 462 | wake_up(&ec->wait); |
| 785 | ec->intr.expect_event = 0; | 463 | } |
| 786 | wake_up(&ec->intr.wait); | ||
| 787 | break; | ||
| 788 | case ACPI_EC_EVENT_IBE: | ||
| 789 | if ((value & ACPI_EC_FLAG_IBF)) | ||
| 790 | break; | ||
| 791 | ec->intr.expect_event = 0; | ||
| 792 | wake_up(&ec->intr.wait); | ||
| 793 | break; | ||
| 794 | default: | ||
| 795 | break; | ||
| 796 | } | 464 | } |
| 797 | 465 | ||
| 798 | if (value & ACPI_EC_FLAG_SCI) { | 466 | if (value & ACPI_EC_FLAG_SCI) { |
| 799 | atomic_add(1, &ec->intr.pending_gpe); | 467 | status = acpi_os_execute(OSL_EC_BURST_HANDLER, acpi_ec_gpe_query, ec); |
| 800 | status = acpi_os_execute(OSL_EC_BURST_HANDLER, | ||
| 801 | acpi_ec_gpe_query, ec); | ||
| 802 | return status == AE_OK ? | 468 | return status == AE_OK ? |
| 803 | ACPI_INTERRUPT_HANDLED : ACPI_INTERRUPT_NOT_HANDLED; | 469 | ACPI_INTERRUPT_HANDLED : ACPI_INTERRUPT_NOT_HANDLED; |
| 804 | } | 470 | } |
| 805 | acpi_enable_gpe(NULL, ec->common.gpe_bit, ACPI_ISR); | 471 | acpi_enable_gpe(NULL, ec->gpe_bit, ACPI_ISR); |
| 806 | return status == AE_OK ? | 472 | return status == AE_OK ? |
| 807 | ACPI_INTERRUPT_HANDLED : ACPI_INTERRUPT_NOT_HANDLED; | 473 | ACPI_INTERRUPT_HANDLED : ACPI_INTERRUPT_NOT_HANDLED; |
| 808 | } | 474 | } |
| @@ -833,7 +499,7 @@ acpi_ec_space_handler(u32 function, | |||
| 833 | void *handler_context, void *region_context) | 499 | void *handler_context, void *region_context) |
| 834 | { | 500 | { |
| 835 | int result = 0; | 501 | int result = 0; |
| 836 | union acpi_ec *ec = NULL; | 502 | struct acpi_ec *ec = NULL; |
| 837 | u64 temp = *value; | 503 | u64 temp = *value; |
| 838 | acpi_integer f_v = 0; | 504 | acpi_integer f_v = 0; |
| 839 | int i = 0; | 505 | int i = 0; |
| @@ -843,18 +509,16 @@ acpi_ec_space_handler(u32 function, | |||
| 843 | return AE_BAD_PARAMETER; | 509 | return AE_BAD_PARAMETER; |
| 844 | 510 | ||
| 845 | if (bit_width != 8 && acpi_strict) { | 511 | if (bit_width != 8 && acpi_strict) { |
| 846 | printk(KERN_WARNING PREFIX | ||
| 847 | "acpi_ec_space_handler: bit_width should be 8\n"); | ||
| 848 | return AE_BAD_PARAMETER; | 512 | return AE_BAD_PARAMETER; |
| 849 | } | 513 | } |
| 850 | 514 | ||
| 851 | ec = (union acpi_ec *)handler_context; | 515 | ec = (struct acpi_ec *)handler_context; |
| 852 | 516 | ||
| 853 | next_byte: | 517 | next_byte: |
| 854 | switch (function) { | 518 | switch (function) { |
| 855 | case ACPI_READ: | 519 | case ACPI_READ: |
| 856 | temp = 0; | 520 | temp = 0; |
| 857 | result = acpi_ec_read(ec, (u8) address, (u32 *) & temp); | 521 | result = acpi_ec_read(ec, (u8) address, (u8 *) &temp); |
| 858 | break; | 522 | break; |
| 859 | case ACPI_WRITE: | 523 | case ACPI_WRITE: |
| 860 | result = acpi_ec_write(ec, (u8) address, (u8) temp); | 524 | result = acpi_ec_write(ec, (u8) address, (u8) temp); |
| @@ -905,20 +569,20 @@ static struct proc_dir_entry *acpi_ec_dir; | |||
| 905 | 569 | ||
| 906 | static int acpi_ec_read_info(struct seq_file *seq, void *offset) | 570 | static int acpi_ec_read_info(struct seq_file *seq, void *offset) |
| 907 | { | 571 | { |
| 908 | union acpi_ec *ec = (union acpi_ec *)seq->private; | 572 | struct acpi_ec *ec = (struct acpi_ec *)seq->private; |
| 909 | 573 | ||
| 910 | 574 | ||
| 911 | if (!ec) | 575 | if (!ec) |
| 912 | goto end; | 576 | goto end; |
| 913 | 577 | ||
| 914 | seq_printf(seq, "gpe bit: 0x%02x\n", | 578 | seq_printf(seq, "gpe bit: 0x%02x\n", |
| 915 | (u32) ec->common.gpe_bit); | 579 | (u32) ec->gpe_bit); |
| 916 | seq_printf(seq, "ports: 0x%02x, 0x%02x\n", | 580 | seq_printf(seq, "ports: 0x%02x, 0x%02x\n", |
| 917 | (u32) ec->common.status_addr.address, | 581 | (u32) ec->command_addr, |
| 918 | (u32) ec->common.data_addr.address); | 582 | (u32) ec->data_addr); |
| 919 | seq_printf(seq, "use global lock: %s\n", | 583 | seq_printf(seq, "use global lock: %s\n", |
| 920 | ec->common.global_lock ? "yes" : "no"); | 584 | ec->global_lock ? "yes" : "no"); |
| 921 | acpi_enable_gpe(NULL, ec->common.gpe_bit, ACPI_NOT_ISR); | 585 | acpi_enable_gpe(NULL, ec->gpe_bit, ACPI_NOT_ISR); |
| 922 | 586 | ||
| 923 | end: | 587 | end: |
| 924 | return 0; | 588 | return 0; |
| @@ -929,7 +593,7 @@ static int acpi_ec_info_open_fs(struct inode *inode, struct file *file) | |||
| 929 | return single_open(file, acpi_ec_read_info, PDE(inode)->data); | 593 | return single_open(file, acpi_ec_read_info, PDE(inode)->data); |
| 930 | } | 594 | } |
| 931 | 595 | ||
| 932 | static const struct file_operations acpi_ec_info_ops = { | 596 | static struct file_operations acpi_ec_info_ops = { |
| 933 | .open = acpi_ec_info_open_fs, | 597 | .open = acpi_ec_info_open_fs, |
| 934 | .read = seq_read, | 598 | .read = seq_read, |
| 935 | .llseek = seq_lseek, | 599 | .llseek = seq_lseek, |
| @@ -978,101 +642,35 @@ static int acpi_ec_remove_fs(struct acpi_device *device) | |||
| 978 | Driver Interface | 642 | Driver Interface |
| 979 | -------------------------------------------------------------------------- */ | 643 | -------------------------------------------------------------------------- */ |
| 980 | 644 | ||
| 981 | static int acpi_ec_poll_add(struct acpi_device *device) | 645 | static int acpi_ec_add(struct acpi_device *device) |
| 982 | { | 646 | { |
| 983 | int result = 0; | 647 | int result = 0; |
| 984 | acpi_status status = AE_OK; | 648 | acpi_status status = AE_OK; |
| 985 | union acpi_ec *ec = NULL; | 649 | struct acpi_ec *ec = NULL; |
| 986 | 650 | ||
| 987 | 651 | ||
| 988 | if (!device) | 652 | if (!device) |
| 989 | return -EINVAL; | 653 | return -EINVAL; |
| 990 | 654 | ||
| 991 | ec = kmalloc(sizeof(union acpi_ec), GFP_KERNEL); | 655 | ec = kmalloc(sizeof(struct acpi_ec), GFP_KERNEL); |
| 992 | if (!ec) | 656 | if (!ec) |
| 993 | return -ENOMEM; | 657 | return -ENOMEM; |
| 994 | memset(ec, 0, sizeof(union acpi_ec)); | 658 | memset(ec, 0, sizeof(struct acpi_ec)); |
| 995 | 659 | ||
| 996 | ec->common.handle = device->handle; | 660 | ec->handle = device->handle; |
| 997 | ec->common.uid = -1; | 661 | ec->uid = -1; |
| 998 | init_MUTEX(&ec->poll.sem); | 662 | init_MUTEX(&ec->sem); |
| 999 | strcpy(acpi_device_name(device), ACPI_EC_DEVICE_NAME); | 663 | if (acpi_ec_mode == EC_INTR) { |
| 1000 | strcpy(acpi_device_class(device), ACPI_EC_CLASS); | 664 | atomic_set(&ec->leaving_burst, 1); |
| 1001 | acpi_driver_data(device) = ec; | 665 | init_waitqueue_head(&ec->wait); |
| 1002 | |||
| 1003 | /* Use the global lock for all EC transactions? */ | ||
| 1004 | acpi_evaluate_integer(ec->common.handle, "_GLK", NULL, | ||
| 1005 | &ec->common.global_lock); | ||
| 1006 | |||
| 1007 | /* XXX we don't test uids, because on some boxes ecdt uid = 0, see: | ||
| 1008 | http://bugzilla.kernel.org/show_bug.cgi?id=6111 */ | ||
| 1009 | if (ec_ecdt) { | ||
| 1010 | acpi_remove_address_space_handler(ACPI_ROOT_OBJECT, | ||
| 1011 | ACPI_ADR_SPACE_EC, | ||
| 1012 | &acpi_ec_space_handler); | ||
| 1013 | |||
| 1014 | acpi_remove_gpe_handler(NULL, ec_ecdt->common.gpe_bit, | ||
| 1015 | &acpi_ec_gpe_handler); | ||
| 1016 | |||
| 1017 | kfree(ec_ecdt); | ||
| 1018 | } | 666 | } |
| 1019 | |||
| 1020 | /* Get GPE bit assignment (EC events). */ | ||
| 1021 | /* TODO: Add support for _GPE returning a package */ | ||
| 1022 | status = | ||
| 1023 | acpi_evaluate_integer(ec->common.handle, "_GPE", NULL, | ||
| 1024 | &ec->common.gpe_bit); | ||
| 1025 | if (ACPI_FAILURE(status)) { | ||
| 1026 | ACPI_EXCEPTION((AE_INFO, status, "Obtaining GPE bit")); | ||
| 1027 | result = -ENODEV; | ||
| 1028 | goto end; | ||
| 1029 | } | ||
| 1030 | |||
| 1031 | result = acpi_ec_add_fs(device); | ||
| 1032 | if (result) | ||
| 1033 | goto end; | ||
| 1034 | |||
| 1035 | printk(KERN_INFO PREFIX "%s [%s] (gpe %d) polling mode.\n", | ||
| 1036 | acpi_device_name(device), acpi_device_bid(device), | ||
| 1037 | (u32) ec->common.gpe_bit); | ||
| 1038 | |||
| 1039 | if (!first_ec) | ||
| 1040 | first_ec = device; | ||
| 1041 | |||
| 1042 | end: | ||
| 1043 | if (result) | ||
| 1044 | kfree(ec); | ||
| 1045 | |||
| 1046 | return result; | ||
| 1047 | } | ||
| 1048 | static int acpi_ec_intr_add(struct acpi_device *device) | ||
| 1049 | { | ||
| 1050 | int result = 0; | ||
| 1051 | acpi_status status = AE_OK; | ||
| 1052 | union acpi_ec *ec = NULL; | ||
| 1053 | |||
| 1054 | |||
| 1055 | if (!device) | ||
| 1056 | return -EINVAL; | ||
| 1057 | |||
| 1058 | ec = kmalloc(sizeof(union acpi_ec), GFP_KERNEL); | ||
| 1059 | if (!ec) | ||
| 1060 | return -ENOMEM; | ||
| 1061 | memset(ec, 0, sizeof(union acpi_ec)); | ||
| 1062 | |||
| 1063 | ec->common.handle = device->handle; | ||
| 1064 | ec->common.uid = -1; | ||
| 1065 | atomic_set(&ec->intr.pending_gpe, 0); | ||
| 1066 | atomic_set(&ec->intr.leaving_burst, 1); | ||
| 1067 | init_MUTEX(&ec->intr.sem); | ||
| 1068 | init_waitqueue_head(&ec->intr.wait); | ||
| 1069 | strcpy(acpi_device_name(device), ACPI_EC_DEVICE_NAME); | 667 | strcpy(acpi_device_name(device), ACPI_EC_DEVICE_NAME); |
| 1070 | strcpy(acpi_device_class(device), ACPI_EC_CLASS); | 668 | strcpy(acpi_device_class(device), ACPI_EC_CLASS); |
| 1071 | acpi_driver_data(device) = ec; | 669 | acpi_driver_data(device) = ec; |
| 1072 | 670 | ||
| 1073 | /* Use the global lock for all EC transactions? */ | 671 | /* Use the global lock for all EC transactions? */ |
| 1074 | acpi_evaluate_integer(ec->common.handle, "_GLK", NULL, | 672 | acpi_evaluate_integer(ec->handle, "_GLK", NULL, |
| 1075 | &ec->common.global_lock); | 673 | &ec->global_lock); |
| 1076 | 674 | ||
| 1077 | /* XXX we don't test uids, because on some boxes ecdt uid = 0, see: | 675 | /* XXX we don't test uids, because on some boxes ecdt uid = 0, see: |
| 1078 | http://bugzilla.kernel.org/show_bug.cgi?id=6111 */ | 676 | http://bugzilla.kernel.org/show_bug.cgi?id=6111 */ |
| @@ -1081,7 +679,7 @@ static int acpi_ec_intr_add(struct acpi_device *device) | |||
| 1081 | ACPI_ADR_SPACE_EC, | 679 | ACPI_ADR_SPACE_EC, |
| 1082 | &acpi_ec_space_handler); | 680 | &acpi_ec_space_handler); |
| 1083 | 681 | ||
| 1084 | acpi_remove_gpe_handler(NULL, ec_ecdt->common.gpe_bit, | 682 | acpi_remove_gpe_handler(NULL, ec_ecdt->gpe_bit, |
| 1085 | &acpi_ec_gpe_handler); | 683 | &acpi_ec_gpe_handler); |
| 1086 | 684 | ||
| 1087 | kfree(ec_ecdt); | 685 | kfree(ec_ecdt); |
| @@ -1090,10 +688,10 @@ static int acpi_ec_intr_add(struct acpi_device *device) | |||
| 1090 | /* Get GPE bit assignment (EC events). */ | 688 | /* Get GPE bit assignment (EC events). */ |
| 1091 | /* TODO: Add support for _GPE returning a package */ | 689 | /* TODO: Add support for _GPE returning a package */ |
| 1092 | status = | 690 | status = |
| 1093 | acpi_evaluate_integer(ec->common.handle, "_GPE", NULL, | 691 | acpi_evaluate_integer(ec->handle, "_GPE", NULL, |
| 1094 | &ec->common.gpe_bit); | 692 | &ec->gpe_bit); |
| 1095 | if (ACPI_FAILURE(status)) { | 693 | if (ACPI_FAILURE(status)) { |
| 1096 | printk(KERN_ERR PREFIX "Obtaining GPE bit assignment\n"); | 694 | ACPI_EXCEPTION((AE_INFO, status, "Obtaining GPE bit assignment")); |
| 1097 | result = -ENODEV; | 695 | result = -ENODEV; |
| 1098 | goto end; | 696 | goto end; |
| 1099 | } | 697 | } |
| @@ -1102,14 +700,14 @@ static int acpi_ec_intr_add(struct acpi_device *device) | |||
| 1102 | if (result) | 700 | if (result) |
| 1103 | goto end; | 701 | goto end; |
| 1104 | 702 | ||
| 1105 | printk(KERN_INFO PREFIX "%s [%s] (gpe %d) interrupt mode.\n", | 703 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s [%s] (gpe %d) interrupt mode.", |
| 1106 | acpi_device_name(device), acpi_device_bid(device), | 704 | acpi_device_name(device), acpi_device_bid(device), |
| 1107 | (u32) ec->common.gpe_bit); | 705 | (u32) ec->gpe_bit)); |
| 1108 | 706 | ||
| 1109 | if (!first_ec) | 707 | if (!first_ec) |
| 1110 | first_ec = device; | 708 | first_ec = device; |
| 1111 | 709 | ||
| 1112 | end: | 710 | end: |
| 1113 | if (result) | 711 | if (result) |
| 1114 | kfree(ec); | 712 | kfree(ec); |
| 1115 | 713 | ||
| @@ -1118,7 +716,7 @@ static int acpi_ec_intr_add(struct acpi_device *device) | |||
| 1118 | 716 | ||
| 1119 | static int acpi_ec_remove(struct acpi_device *device, int type) | 717 | static int acpi_ec_remove(struct acpi_device *device, int type) |
| 1120 | { | 718 | { |
| 1121 | union acpi_ec *ec = NULL; | 719 | struct acpi_ec *ec = NULL; |
| 1122 | 720 | ||
| 1123 | 721 | ||
| 1124 | if (!device) | 722 | if (!device) |
| @@ -1136,8 +734,7 @@ static int acpi_ec_remove(struct acpi_device *device, int type) | |||
| 1136 | static acpi_status | 734 | static acpi_status |
| 1137 | acpi_ec_io_ports(struct acpi_resource *resource, void *context) | 735 | acpi_ec_io_ports(struct acpi_resource *resource, void *context) |
| 1138 | { | 736 | { |
| 1139 | union acpi_ec *ec = (union acpi_ec *)context; | 737 | struct acpi_ec *ec = (struct acpi_ec *)context; |
| 1140 | struct acpi_generic_address *addr; | ||
| 1141 | 738 | ||
| 1142 | if (resource->type != ACPI_RESOURCE_TYPE_IO) { | 739 | if (resource->type != ACPI_RESOURCE_TYPE_IO) { |
| 1143 | return AE_OK; | 740 | return AE_OK; |
| @@ -1148,26 +745,21 @@ acpi_ec_io_ports(struct acpi_resource *resource, void *context) | |||
| 1148 | * the second address region returned is the status/command | 745 | * the second address region returned is the status/command |
| 1149 | * port. | 746 | * port. |
| 1150 | */ | 747 | */ |
| 1151 | if (ec->common.data_addr.register_bit_width == 0) { | 748 | if (ec->data_addr == 0) { |
| 1152 | addr = &ec->common.data_addr; | 749 | ec->data_addr = resource->data.io.minimum; |
| 1153 | } else if (ec->common.command_addr.register_bit_width == 0) { | 750 | } else if (ec->command_addr == 0) { |
| 1154 | addr = &ec->common.command_addr; | 751 | ec->command_addr = resource->data.io.minimum; |
| 1155 | } else { | 752 | } else { |
| 1156 | return AE_CTRL_TERMINATE; | 753 | return AE_CTRL_TERMINATE; |
| 1157 | } | 754 | } |
| 1158 | 755 | ||
| 1159 | addr->address_space_id = ACPI_ADR_SPACE_SYSTEM_IO; | ||
| 1160 | addr->register_bit_width = 8; | ||
| 1161 | addr->register_bit_offset = 0; | ||
| 1162 | addr->address = resource->data.io.minimum; | ||
| 1163 | |||
| 1164 | return AE_OK; | 756 | return AE_OK; |
| 1165 | } | 757 | } |
| 1166 | 758 | ||
| 1167 | static int acpi_ec_start(struct acpi_device *device) | 759 | static int acpi_ec_start(struct acpi_device *device) |
| 1168 | { | 760 | { |
| 1169 | acpi_status status = AE_OK; | 761 | acpi_status status = AE_OK; |
| 1170 | union acpi_ec *ec = NULL; | 762 | struct acpi_ec *ec = NULL; |
| 1171 | 763 | ||
| 1172 | 764 | ||
| 1173 | if (!device) | 765 | if (!device) |
| @@ -1181,39 +773,35 @@ static int acpi_ec_start(struct acpi_device *device) | |||
| 1181 | /* | 773 | /* |
| 1182 | * Get I/O port addresses. Convert to GAS format. | 774 | * Get I/O port addresses. Convert to GAS format. |
| 1183 | */ | 775 | */ |
| 1184 | status = acpi_walk_resources(ec->common.handle, METHOD_NAME__CRS, | 776 | status = acpi_walk_resources(ec->handle, METHOD_NAME__CRS, |
| 1185 | acpi_ec_io_ports, ec); | 777 | acpi_ec_io_ports, ec); |
| 1186 | if (ACPI_FAILURE(status) | 778 | if (ACPI_FAILURE(status) || ec->command_addr == 0) { |
| 1187 | || ec->common.command_addr.register_bit_width == 0) { | 779 | ACPI_EXCEPTION((AE_INFO, status, |
| 1188 | printk(KERN_ERR PREFIX "Error getting I/O port addresses\n"); | 780 | "Error getting I/O port addresses")); |
| 1189 | return -ENODEV; | 781 | return -ENODEV; |
| 1190 | } | 782 | } |
| 1191 | 783 | ||
| 1192 | ec->common.status_addr = ec->common.command_addr; | 784 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "gpe=0x%02lx, ports=0x%2lx,0x%2lx", |
| 1193 | 785 | ec->gpe_bit, ec->command_addr, ec->data_addr)); | |
| 1194 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "gpe=0x%02x, ports=0x%2x,0x%2x\n", | ||
| 1195 | (u32) ec->common.gpe_bit, | ||
| 1196 | (u32) ec->common.command_addr.address, | ||
| 1197 | (u32) ec->common.data_addr.address)); | ||
| 1198 | 786 | ||
| 1199 | /* | 787 | /* |
| 1200 | * Install GPE handler | 788 | * Install GPE handler |
| 1201 | */ | 789 | */ |
| 1202 | status = acpi_install_gpe_handler(NULL, ec->common.gpe_bit, | 790 | status = acpi_install_gpe_handler(NULL, ec->gpe_bit, |
| 1203 | ACPI_GPE_EDGE_TRIGGERED, | 791 | ACPI_GPE_EDGE_TRIGGERED, |
| 1204 | &acpi_ec_gpe_handler, ec); | 792 | &acpi_ec_gpe_handler, ec); |
| 1205 | if (ACPI_FAILURE(status)) { | 793 | if (ACPI_FAILURE(status)) { |
| 1206 | return -ENODEV; | 794 | return -ENODEV; |
| 1207 | } | 795 | } |
| 1208 | acpi_set_gpe_type(NULL, ec->common.gpe_bit, ACPI_GPE_TYPE_RUNTIME); | 796 | acpi_set_gpe_type(NULL, ec->gpe_bit, ACPI_GPE_TYPE_RUNTIME); |
| 1209 | acpi_enable_gpe(NULL, ec->common.gpe_bit, ACPI_NOT_ISR); | 797 | acpi_enable_gpe(NULL, ec->gpe_bit, ACPI_NOT_ISR); |
| 1210 | 798 | ||
| 1211 | status = acpi_install_address_space_handler(ec->common.handle, | 799 | status = acpi_install_address_space_handler(ec->handle, |
| 1212 | ACPI_ADR_SPACE_EC, | 800 | ACPI_ADR_SPACE_EC, |
| 1213 | &acpi_ec_space_handler, | 801 | &acpi_ec_space_handler, |
| 1214 | &acpi_ec_space_setup, ec); | 802 | &acpi_ec_space_setup, ec); |
| 1215 | if (ACPI_FAILURE(status)) { | 803 | if (ACPI_FAILURE(status)) { |
| 1216 | acpi_remove_gpe_handler(NULL, ec->common.gpe_bit, | 804 | acpi_remove_gpe_handler(NULL, ec->gpe_bit, |
| 1217 | &acpi_ec_gpe_handler); | 805 | &acpi_ec_gpe_handler); |
| 1218 | return -ENODEV; | 806 | return -ENODEV; |
| 1219 | } | 807 | } |
| @@ -1224,7 +812,7 @@ static int acpi_ec_start(struct acpi_device *device) | |||
| 1224 | static int acpi_ec_stop(struct acpi_device *device, int type) | 812 | static int acpi_ec_stop(struct acpi_device *device, int type) |
| 1225 | { | 813 | { |
| 1226 | acpi_status status = AE_OK; | 814 | acpi_status status = AE_OK; |
| 1227 | union acpi_ec *ec = NULL; | 815 | struct acpi_ec *ec = NULL; |
| 1228 | 816 | ||
| 1229 | 817 | ||
| 1230 | if (!device) | 818 | if (!device) |
| @@ -1232,14 +820,14 @@ static int acpi_ec_stop(struct acpi_device *device, int type) | |||
| 1232 | 820 | ||
| 1233 | ec = acpi_driver_data(device); | 821 | ec = acpi_driver_data(device); |
| 1234 | 822 | ||
| 1235 | status = acpi_remove_address_space_handler(ec->common.handle, | 823 | status = acpi_remove_address_space_handler(ec->handle, |
| 1236 | ACPI_ADR_SPACE_EC, | 824 | ACPI_ADR_SPACE_EC, |
| 1237 | &acpi_ec_space_handler); | 825 | &acpi_ec_space_handler); |
| 1238 | if (ACPI_FAILURE(status)) | 826 | if (ACPI_FAILURE(status)) |
| 1239 | return -ENODEV; | 827 | return -ENODEV; |
| 1240 | 828 | ||
| 1241 | status = | 829 | status = |
| 1242 | acpi_remove_gpe_handler(NULL, ec->common.gpe_bit, | 830 | acpi_remove_gpe_handler(NULL, ec->gpe_bit, |
| 1243 | &acpi_ec_gpe_handler); | 831 | &acpi_ec_gpe_handler); |
| 1244 | if (ACPI_FAILURE(status)) | 832 | if (ACPI_FAILURE(status)) |
| 1245 | return -ENODEV; | 833 | return -ENODEV; |
| @@ -1251,76 +839,30 @@ static acpi_status __init | |||
| 1251 | acpi_fake_ecdt_callback(acpi_handle handle, | 839 | acpi_fake_ecdt_callback(acpi_handle handle, |
| 1252 | u32 Level, void *context, void **retval) | 840 | u32 Level, void *context, void **retval) |
| 1253 | { | 841 | { |
| 1254 | |||
| 1255 | if (acpi_ec_poll_mode) | ||
| 1256 | return acpi_fake_ecdt_poll_callback(handle, | ||
| 1257 | Level, context, retval); | ||
| 1258 | else | ||
| 1259 | return acpi_fake_ecdt_intr_callback(handle, | ||
| 1260 | Level, context, retval); | ||
| 1261 | } | ||
| 1262 | |||
| 1263 | static acpi_status __init | ||
| 1264 | acpi_fake_ecdt_poll_callback(acpi_handle handle, | ||
| 1265 | u32 Level, void *context, void **retval) | ||
| 1266 | { | ||
| 1267 | acpi_status status; | ||
| 1268 | |||
| 1269 | status = acpi_walk_resources(handle, METHOD_NAME__CRS, | ||
| 1270 | acpi_ec_io_ports, ec_ecdt); | ||
| 1271 | if (ACPI_FAILURE(status)) | ||
| 1272 | return status; | ||
| 1273 | ec_ecdt->common.status_addr = ec_ecdt->common.command_addr; | ||
| 1274 | |||
| 1275 | ec_ecdt->common.uid = -1; | ||
| 1276 | acpi_evaluate_integer(handle, "_UID", NULL, &ec_ecdt->common.uid); | ||
| 1277 | |||
| 1278 | status = | ||
| 1279 | acpi_evaluate_integer(handle, "_GPE", NULL, | ||
| 1280 | &ec_ecdt->common.gpe_bit); | ||
| 1281 | if (ACPI_FAILURE(status)) | ||
| 1282 | return status; | ||
| 1283 | init_MUTEX(&ec_ecdt->poll.sem); | ||
| 1284 | ec_ecdt->common.global_lock = TRUE; | ||
| 1285 | ec_ecdt->common.handle = handle; | ||
| 1286 | |||
| 1287 | printk(KERN_INFO PREFIX "GPE=0x%02x, ports=0x%2x, 0x%2x\n", | ||
| 1288 | (u32) ec_ecdt->common.gpe_bit, | ||
| 1289 | (u32) ec_ecdt->common.command_addr.address, | ||
| 1290 | (u32) ec_ecdt->common.data_addr.address); | ||
| 1291 | |||
| 1292 | return AE_CTRL_TERMINATE; | ||
| 1293 | } | ||
| 1294 | |||
| 1295 | static acpi_status __init | ||
| 1296 | acpi_fake_ecdt_intr_callback(acpi_handle handle, | ||
| 1297 | u32 Level, void *context, void **retval) | ||
| 1298 | { | ||
| 1299 | acpi_status status; | 842 | acpi_status status; |
| 1300 | 843 | ||
| 1301 | init_MUTEX(&ec_ecdt->intr.sem); | 844 | init_MUTEX(&ec_ecdt->sem); |
| 1302 | init_waitqueue_head(&ec_ecdt->intr.wait); | 845 | if (acpi_ec_mode == EC_INTR) { |
| 846 | init_waitqueue_head(&ec_ecdt->wait); | ||
| 847 | } | ||
| 1303 | status = acpi_walk_resources(handle, METHOD_NAME__CRS, | 848 | status = acpi_walk_resources(handle, METHOD_NAME__CRS, |
| 1304 | acpi_ec_io_ports, ec_ecdt); | 849 | acpi_ec_io_ports, ec_ecdt); |
| 1305 | if (ACPI_FAILURE(status)) | 850 | if (ACPI_FAILURE(status)) |
| 1306 | return status; | 851 | return status; |
| 1307 | ec_ecdt->common.status_addr = ec_ecdt->common.command_addr; | ||
| 1308 | 852 | ||
| 1309 | ec_ecdt->common.uid = -1; | 853 | ec_ecdt->uid = -1; |
| 1310 | acpi_evaluate_integer(handle, "_UID", NULL, &ec_ecdt->common.uid); | 854 | acpi_evaluate_integer(handle, "_UID", NULL, &ec_ecdt->uid); |
| 1311 | 855 | ||
| 1312 | status = | 856 | status = |
| 1313 | acpi_evaluate_integer(handle, "_GPE", NULL, | 857 | acpi_evaluate_integer(handle, "_GPE", NULL, |
| 1314 | &ec_ecdt->common.gpe_bit); | 858 | &ec_ecdt->gpe_bit); |
| 1315 | if (ACPI_FAILURE(status)) | 859 | if (ACPI_FAILURE(status)) |
| 1316 | return status; | 860 | return status; |
| 1317 | ec_ecdt->common.global_lock = TRUE; | 861 | ec_ecdt->global_lock = TRUE; |
| 1318 | ec_ecdt->common.handle = handle; | 862 | ec_ecdt->handle = handle; |
| 1319 | 863 | ||
| 1320 | printk(KERN_INFO PREFIX "GPE=0x%02x, ports=0x%2x, 0x%2x\n", | 864 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "GPE=0x%02lx, ports=0x%2lx, 0x%2lx", |
| 1321 | (u32) ec_ecdt->common.gpe_bit, | 865 | ec_ecdt->gpe_bit, ec_ecdt->command_addr, ec_ecdt->data_addr)); |
| 1322 | (u32) ec_ecdt->common.command_addr.address, | ||
| 1323 | (u32) ec_ecdt->common.data_addr.address); | ||
| 1324 | 866 | ||
| 1325 | return AE_CTRL_TERMINATE; | 867 | return AE_CTRL_TERMINATE; |
| 1326 | } | 868 | } |
| @@ -1340,14 +882,14 @@ static int __init acpi_ec_fake_ecdt(void) | |||
| 1340 | acpi_status status; | 882 | acpi_status status; |
| 1341 | int ret = 0; | 883 | int ret = 0; |
| 1342 | 884 | ||
| 1343 | printk(KERN_INFO PREFIX "Try to make an fake ECDT\n"); | 885 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Try to make an fake ECDT")); |
| 1344 | 886 | ||
| 1345 | ec_ecdt = kmalloc(sizeof(union acpi_ec), GFP_KERNEL); | 887 | ec_ecdt = kmalloc(sizeof(struct acpi_ec), GFP_KERNEL); |
| 1346 | if (!ec_ecdt) { | 888 | if (!ec_ecdt) { |
| 1347 | ret = -ENOMEM; | 889 | ret = -ENOMEM; |
| 1348 | goto error; | 890 | goto error; |
| 1349 | } | 891 | } |
| 1350 | memset(ec_ecdt, 0, sizeof(union acpi_ec)); | 892 | memset(ec_ecdt, 0, sizeof(struct acpi_ec)); |
| 1351 | 893 | ||
| 1352 | status = acpi_get_devices(ACPI_EC_HID, | 894 | status = acpi_get_devices(ACPI_EC_HID, |
| 1353 | acpi_fake_ecdt_callback, NULL, NULL); | 895 | acpi_fake_ecdt_callback, NULL, NULL); |
| @@ -1355,24 +897,16 @@ static int __init acpi_ec_fake_ecdt(void) | |||
| 1355 | kfree(ec_ecdt); | 897 | kfree(ec_ecdt); |
| 1356 | ec_ecdt = NULL; | 898 | ec_ecdt = NULL; |
| 1357 | ret = -ENODEV; | 899 | ret = -ENODEV; |
| 900 | ACPI_EXCEPTION((AE_INFO, status, "Can't make an fake ECDT")); | ||
| 1358 | goto error; | 901 | goto error; |
| 1359 | } | 902 | } |
| 1360 | return 0; | 903 | return 0; |
| 1361 | error: | 904 | error: |
| 1362 | printk(KERN_ERR PREFIX "Can't make an fake ECDT\n"); | ||
| 1363 | return ret; | 905 | return ret; |
| 1364 | } | 906 | } |
| 1365 | 907 | ||
| 1366 | static int __init acpi_ec_get_real_ecdt(void) | 908 | static int __init acpi_ec_get_real_ecdt(void) |
| 1367 | { | 909 | { |
| 1368 | if (acpi_ec_poll_mode) | ||
| 1369 | return acpi_ec_poll_get_real_ecdt(); | ||
| 1370 | else | ||
| 1371 | return acpi_ec_intr_get_real_ecdt(); | ||
| 1372 | } | ||
| 1373 | |||
| 1374 | static int __init acpi_ec_poll_get_real_ecdt(void) | ||
| 1375 | { | ||
| 1376 | acpi_status status; | 910 | acpi_status status; |
| 1377 | struct acpi_table_ecdt *ecdt_ptr; | 911 | struct acpi_table_ecdt *ecdt_ptr; |
| 1378 | 912 | ||
| @@ -1382,80 +916,36 @@ static int __init acpi_ec_poll_get_real_ecdt(void) | |||
| 1382 | if (ACPI_FAILURE(status)) | 916 | if (ACPI_FAILURE(status)) |
| 1383 | return -ENODEV; | 917 | return -ENODEV; |
| 1384 | 918 | ||
| 1385 | printk(KERN_INFO PREFIX "Found ECDT\n"); | 919 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found ECDT")); |
| 1386 | 920 | ||
| 1387 | /* | 921 | /* |
| 1388 | * Generate a temporary ec context to use until the namespace is scanned | 922 | * Generate a temporary ec context to use until the namespace is scanned |
| 1389 | */ | 923 | */ |
| 1390 | ec_ecdt = kmalloc(sizeof(union acpi_ec), GFP_KERNEL); | 924 | ec_ecdt = kmalloc(sizeof(struct acpi_ec), GFP_KERNEL); |
| 1391 | if (!ec_ecdt) | 925 | if (!ec_ecdt) |
| 1392 | return -ENOMEM; | 926 | return -ENOMEM; |
| 1393 | memset(ec_ecdt, 0, sizeof(union acpi_ec)); | 927 | memset(ec_ecdt, 0, sizeof(struct acpi_ec)); |
| 1394 | |||
| 1395 | ec_ecdt->common.command_addr = ecdt_ptr->ec_control; | ||
| 1396 | ec_ecdt->common.status_addr = ecdt_ptr->ec_control; | ||
| 1397 | ec_ecdt->common.data_addr = ecdt_ptr->ec_data; | ||
| 1398 | ec_ecdt->common.gpe_bit = ecdt_ptr->gpe_bit; | ||
| 1399 | init_MUTEX(&ec_ecdt->poll.sem); | ||
| 1400 | /* use the GL just to be safe */ | ||
| 1401 | ec_ecdt->common.global_lock = TRUE; | ||
| 1402 | ec_ecdt->common.uid = ecdt_ptr->uid; | ||
| 1403 | 928 | ||
| 1404 | status = | 929 | init_MUTEX(&ec_ecdt->sem); |
| 1405 | acpi_get_handle(NULL, ecdt_ptr->ec_id, &ec_ecdt->common.handle); | 930 | if (acpi_ec_mode == EC_INTR) { |
| 1406 | if (ACPI_FAILURE(status)) { | 931 | init_waitqueue_head(&ec_ecdt->wait); |
| 1407 | goto error; | ||
| 1408 | } | 932 | } |
| 1409 | 933 | ec_ecdt->command_addr = ecdt_ptr->ec_control.address; | |
| 1410 | return 0; | 934 | ec_ecdt->data_addr = ecdt_ptr->ec_data.address; |
| 1411 | error: | 935 | ec_ecdt->gpe_bit = ecdt_ptr->gpe_bit; |
| 1412 | printk(KERN_ERR PREFIX "Could not use ECDT\n"); | ||
| 1413 | kfree(ec_ecdt); | ||
| 1414 | ec_ecdt = NULL; | ||
| 1415 | |||
| 1416 | return -ENODEV; | ||
| 1417 | } | ||
| 1418 | |||
| 1419 | static int __init acpi_ec_intr_get_real_ecdt(void) | ||
| 1420 | { | ||
| 1421 | acpi_status status; | ||
| 1422 | struct acpi_table_ecdt *ecdt_ptr; | ||
| 1423 | |||
| 1424 | status = acpi_get_firmware_table("ECDT", 1, ACPI_LOGICAL_ADDRESSING, | ||
| 1425 | (struct acpi_table_header **) | ||
| 1426 | &ecdt_ptr); | ||
| 1427 | if (ACPI_FAILURE(status)) | ||
| 1428 | return -ENODEV; | ||
| 1429 | |||
| 1430 | printk(KERN_INFO PREFIX "Found ECDT\n"); | ||
| 1431 | |||
| 1432 | /* | ||
| 1433 | * Generate a temporary ec context to use until the namespace is scanned | ||
| 1434 | */ | ||
| 1435 | ec_ecdt = kmalloc(sizeof(union acpi_ec), GFP_KERNEL); | ||
| 1436 | if (!ec_ecdt) | ||
| 1437 | return -ENOMEM; | ||
| 1438 | memset(ec_ecdt, 0, sizeof(union acpi_ec)); | ||
| 1439 | |||
| 1440 | init_MUTEX(&ec_ecdt->intr.sem); | ||
| 1441 | init_waitqueue_head(&ec_ecdt->intr.wait); | ||
| 1442 | ec_ecdt->common.command_addr = ecdt_ptr->ec_control; | ||
| 1443 | ec_ecdt->common.status_addr = ecdt_ptr->ec_control; | ||
| 1444 | ec_ecdt->common.data_addr = ecdt_ptr->ec_data; | ||
| 1445 | ec_ecdt->common.gpe_bit = ecdt_ptr->gpe_bit; | ||
| 1446 | /* use the GL just to be safe */ | 936 | /* use the GL just to be safe */ |
| 1447 | ec_ecdt->common.global_lock = TRUE; | 937 | ec_ecdt->global_lock = TRUE; |
| 1448 | ec_ecdt->common.uid = ecdt_ptr->uid; | 938 | ec_ecdt->uid = ecdt_ptr->uid; |
| 1449 | 939 | ||
| 1450 | status = | 940 | status = |
| 1451 | acpi_get_handle(NULL, ecdt_ptr->ec_id, &ec_ecdt->common.handle); | 941 | acpi_get_handle(NULL, ecdt_ptr->ec_id, &ec_ecdt->handle); |
| 1452 | if (ACPI_FAILURE(status)) { | 942 | if (ACPI_FAILURE(status)) { |
| 1453 | goto error; | 943 | goto error; |
| 1454 | } | 944 | } |
| 1455 | 945 | ||
| 1456 | return 0; | 946 | return 0; |
| 1457 | error: | 947 | error: |
| 1458 | printk(KERN_ERR PREFIX "Could not use ECDT\n"); | 948 | ACPI_EXCEPTION((AE_INFO, status, "Could not use ECDT")); |
| 1459 | kfree(ec_ecdt); | 949 | kfree(ec_ecdt); |
| 1460 | ec_ecdt = NULL; | 950 | ec_ecdt = NULL; |
| 1461 | 951 | ||
| @@ -1480,14 +970,14 @@ int __init acpi_ec_ecdt_probe(void) | |||
| 1480 | /* | 970 | /* |
| 1481 | * Install GPE handler | 971 | * Install GPE handler |
| 1482 | */ | 972 | */ |
| 1483 | status = acpi_install_gpe_handler(NULL, ec_ecdt->common.gpe_bit, | 973 | status = acpi_install_gpe_handler(NULL, ec_ecdt->gpe_bit, |
| 1484 | ACPI_GPE_EDGE_TRIGGERED, | 974 | ACPI_GPE_EDGE_TRIGGERED, |
| 1485 | &acpi_ec_gpe_handler, ec_ecdt); | 975 | &acpi_ec_gpe_handler, ec_ecdt); |
| 1486 | if (ACPI_FAILURE(status)) { | 976 | if (ACPI_FAILURE(status)) { |
| 1487 | goto error; | 977 | goto error; |
| 1488 | } | 978 | } |
| 1489 | acpi_set_gpe_type(NULL, ec_ecdt->common.gpe_bit, ACPI_GPE_TYPE_RUNTIME); | 979 | acpi_set_gpe_type(NULL, ec_ecdt->gpe_bit, ACPI_GPE_TYPE_RUNTIME); |
| 1490 | acpi_enable_gpe(NULL, ec_ecdt->common.gpe_bit, ACPI_NOT_ISR); | 980 | acpi_enable_gpe(NULL, ec_ecdt->gpe_bit, ACPI_NOT_ISR); |
| 1491 | 981 | ||
| 1492 | status = acpi_install_address_space_handler(ACPI_ROOT_OBJECT, | 982 | status = acpi_install_address_space_handler(ACPI_ROOT_OBJECT, |
| 1493 | ACPI_ADR_SPACE_EC, | 983 | ACPI_ADR_SPACE_EC, |
| @@ -1495,7 +985,7 @@ int __init acpi_ec_ecdt_probe(void) | |||
| 1495 | &acpi_ec_space_setup, | 985 | &acpi_ec_space_setup, |
| 1496 | ec_ecdt); | 986 | ec_ecdt); |
| 1497 | if (ACPI_FAILURE(status)) { | 987 | if (ACPI_FAILURE(status)) { |
| 1498 | acpi_remove_gpe_handler(NULL, ec_ecdt->common.gpe_bit, | 988 | acpi_remove_gpe_handler(NULL, ec_ecdt->gpe_bit, |
| 1499 | &acpi_ec_gpe_handler); | 989 | &acpi_ec_gpe_handler); |
| 1500 | goto error; | 990 | goto error; |
| 1501 | } | 991 | } |
| @@ -1503,7 +993,7 @@ int __init acpi_ec_ecdt_probe(void) | |||
| 1503 | return 0; | 993 | return 0; |
| 1504 | 994 | ||
| 1505 | error: | 995 | error: |
| 1506 | printk(KERN_ERR PREFIX "Could not use ECDT\n"); | 996 | ACPI_EXCEPTION((AE_INFO, status, "Could not use ECDT")); |
| 1507 | kfree(ec_ecdt); | 997 | kfree(ec_ecdt); |
| 1508 | ec_ecdt = NULL; | 998 | ec_ecdt = NULL; |
| 1509 | 999 | ||
| @@ -1562,13 +1052,13 @@ static int __init acpi_ec_set_intr_mode(char *str) | |||
| 1562 | return 0; | 1052 | return 0; |
| 1563 | 1053 | ||
| 1564 | if (intr) { | 1054 | if (intr) { |
| 1565 | acpi_ec_poll_mode = EC_INTR; | 1055 | acpi_ec_mode = EC_INTR; |
| 1566 | acpi_ec_driver.ops.add = acpi_ec_intr_add; | ||
| 1567 | } else { | 1056 | } else { |
| 1568 | acpi_ec_poll_mode = EC_POLL; | 1057 | acpi_ec_mode = EC_POLL; |
| 1569 | acpi_ec_driver.ops.add = acpi_ec_poll_add; | ||
| 1570 | } | 1058 | } |
| 1571 | printk(KERN_INFO PREFIX "EC %s mode.\n", intr ? "interrupt" : "polling"); | 1059 | acpi_ec_driver.ops.add = acpi_ec_add; |
| 1060 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "EC %s mode.\n", intr ? "interrupt" : "polling")); | ||
| 1061 | |||
| 1572 | return 1; | 1062 | return 1; |
| 1573 | } | 1063 | } |
| 1574 | 1064 | ||
