diff options
| author | Alexey Starikovskiy <astarikovskiy@suse.de> | 2007-09-26 11:43:28 -0400 |
|---|---|---|
| committer | Len Brown <len.brown@intel.com> | 2007-09-27 15:50:22 -0400 |
| commit | 91087dfa51a29b3c190e99339c4c32eb13646c51 (patch) | |
| tree | cb508e1786c46d6dbc56292dbdae26a598a3593a | |
| parent | 30c08574da0ead1a47797ce028218ce5b2de61c7 (diff) | |
ACPI: SBS: Split host controller (ACPI0001) from SBS driver (ACPI0002)
Replace poll-based host controller driver with the notify-based one.
Split it out of sbs.c.
Signed-off-by: Alexey Starikovskiy <astarikovskiy@suse.de>
Signed-off-by: Len Brown <len.brown@intel.com>
| -rw-r--r-- | drivers/acpi/Makefile | 1 | ||||
| -rw-r--r-- | drivers/acpi/sbs.c | 374 | ||||
| -rw-r--r-- | drivers/acpi/sbshc.c | 309 | ||||
| -rw-r--r-- | drivers/acpi/sbshc.h | 27 |
4 files changed, 412 insertions, 299 deletions
diff --git a/drivers/acpi/Makefile b/drivers/acpi/Makefile index d4336f1730e9..54e3ab0e5fc0 100644 --- a/drivers/acpi/Makefile +++ b/drivers/acpi/Makefile | |||
| @@ -60,3 +60,4 @@ obj-$(CONFIG_ACPI_TOSHIBA) += toshiba_acpi.o | |||
| 60 | obj-$(CONFIG_ACPI_HOTPLUG_MEMORY) += acpi_memhotplug.o | 60 | obj-$(CONFIG_ACPI_HOTPLUG_MEMORY) += acpi_memhotplug.o |
| 61 | obj-y += cm_sbs.o | 61 | obj-y += cm_sbs.o |
| 62 | obj-$(CONFIG_ACPI_SBS) += sbs.o | 62 | obj-$(CONFIG_ACPI_SBS) += sbs.o |
| 63 | obj-$(CONFIG_ACPI_SBS) += sbshc.o | ||
diff --git a/drivers/acpi/sbs.c b/drivers/acpi/sbs.c index 33ba4bf551ef..7bb8c62fb92c 100644 --- a/drivers/acpi/sbs.c +++ b/drivers/acpi/sbs.c | |||
| @@ -34,6 +34,8 @@ | |||
| 34 | #include <linux/jiffies.h> | 34 | #include <linux/jiffies.h> |
| 35 | #include <linux/delay.h> | 35 | #include <linux/delay.h> |
| 36 | 36 | ||
| 37 | #include "sbshc.h" | ||
| 38 | |||
| 37 | #define ACPI_SBS_COMPONENT 0x00080000 | 39 | #define ACPI_SBS_COMPONENT 0x00080000 |
| 38 | #define ACPI_SBS_CLASS "sbs" | 40 | #define ACPI_SBS_CLASS "sbs" |
| 39 | #define ACPI_AC_CLASS "ac_adapter" | 41 | #define ACPI_AC_CLASS "ac_adapter" |
| @@ -59,28 +61,6 @@ MODULE_AUTHOR("Rich Townsend"); | |||
| 59 | MODULE_DESCRIPTION("Smart Battery System ACPI interface driver"); | 61 | MODULE_DESCRIPTION("Smart Battery System ACPI interface driver"); |
| 60 | MODULE_LICENSE("GPL"); | 62 | MODULE_LICENSE("GPL"); |
| 61 | 63 | ||
| 62 | #define xmsleep(t) msleep(t) | ||
| 63 | |||
| 64 | #define ACPI_EC_SMB_PRTCL 0x00 /* protocol, PEC */ | ||
| 65 | |||
| 66 | #define ACPI_EC_SMB_STS 0x01 /* status */ | ||
| 67 | #define ACPI_EC_SMB_ADDR 0x02 /* address */ | ||
| 68 | #define ACPI_EC_SMB_CMD 0x03 /* command */ | ||
| 69 | #define ACPI_EC_SMB_DATA 0x04 /* 32 data registers */ | ||
| 70 | #define ACPI_EC_SMB_BCNT 0x24 /* number of data bytes */ | ||
| 71 | |||
| 72 | #define ACPI_EC_SMB_STS_DONE 0x80 | ||
| 73 | #define ACPI_EC_SMB_STS_STATUS 0x1f | ||
| 74 | |||
| 75 | #define ACPI_EC_SMB_PRTCL_WRITE 0x00 | ||
| 76 | #define ACPI_EC_SMB_PRTCL_READ 0x01 | ||
| 77 | #define ACPI_EC_SMB_PRTCL_WORD_DATA 0x08 | ||
| 78 | #define ACPI_EC_SMB_PRTCL_BLOCK_DATA 0x0a | ||
| 79 | |||
| 80 | #define ACPI_EC_SMB_TRANSACTION_SLEEP 1 | ||
| 81 | #define ACPI_EC_SMB_ACCESS_SLEEP1 1 | ||
| 82 | #define ACPI_EC_SMB_ACCESS_SLEEP2 10 | ||
| 83 | |||
| 84 | #define DEF_CAPACITY_UNIT 3 | 64 | #define DEF_CAPACITY_UNIT 3 |
| 85 | #define MAH_CAPACITY_UNIT 1 | 65 | #define MAH_CAPACITY_UNIT 1 |
| 86 | #define MWH_CAPACITY_UNIT 2 | 66 | #define MWH_CAPACITY_UNIT 2 |
| @@ -103,12 +83,6 @@ extern void acpi_unlock_battery_dir(struct proc_dir_entry *acpi_battery_dir); | |||
| 103 | #define MAX_SBS_BAT 4 | 83 | #define MAX_SBS_BAT 4 |
| 104 | #define ACPI_SBS_BLOCK_MAX 32 | 84 | #define ACPI_SBS_BLOCK_MAX 32 |
| 105 | 85 | ||
| 106 | #define ACPI_SBS_SMBUS_READ 1 | ||
| 107 | #define ACPI_SBS_SMBUS_WRITE 2 | ||
| 108 | |||
| 109 | #define ACPI_SBS_WORD_DATA 1 | ||
| 110 | #define ACPI_SBS_BLOCK_DATA 2 | ||
| 111 | |||
| 112 | #define UPDATE_DELAY 10 | 86 | #define UPDATE_DELAY 10 |
| 113 | 87 | ||
| 114 | /* 0 - every time, > 0 - by update_time */ | 88 | /* 0 - every time, > 0 - by update_time */ |
| @@ -124,8 +98,7 @@ static int acpi_sbs_remove(struct acpi_device *device, int type); | |||
| 124 | static int acpi_sbs_resume(struct acpi_device *device); | 98 | static int acpi_sbs_resume(struct acpi_device *device); |
| 125 | 99 | ||
| 126 | static const struct acpi_device_id sbs_device_ids[] = { | 100 | static const struct acpi_device_id sbs_device_ids[] = { |
| 127 | {"ACPI0001", 0}, | 101 | {"ACPI0002", 0}, |
| 128 | {"ACPI0005", 0}, | ||
| 129 | {"", 0}, | 102 | {"", 0}, |
| 130 | }; | 103 | }; |
| 131 | MODULE_DEVICE_TABLE(acpi, sbs_device_ids); | 104 | MODULE_DEVICE_TABLE(acpi, sbs_device_ids); |
| @@ -182,8 +155,8 @@ struct acpi_battery { | |||
| 182 | }; | 155 | }; |
| 183 | 156 | ||
| 184 | struct acpi_sbs { | 157 | struct acpi_sbs { |
| 185 | int base; | ||
| 186 | struct acpi_device *device; | 158 | struct acpi_device *device; |
| 159 | struct acpi_smb_hc *hc; | ||
| 187 | struct mutex mutex; | 160 | struct mutex mutex; |
| 188 | int sbsm_present; | 161 | int sbsm_present; |
| 189 | int sbsm_batteries_supported; | 162 | int sbsm_batteries_supported; |
| @@ -199,190 +172,6 @@ struct acpi_sbs { | |||
| 199 | static int acpi_sbs_update_run(struct acpi_sbs *sbs, int id, int data_type); | 172 | static int acpi_sbs_update_run(struct acpi_sbs *sbs, int id, int data_type); |
| 200 | static void acpi_sbs_update_time(void *data); | 173 | static void acpi_sbs_update_time(void *data); |
| 201 | 174 | ||
| 202 | union sbs_rw_data { | ||
| 203 | u16 word; | ||
| 204 | u8 block[ACPI_SBS_BLOCK_MAX + 2]; | ||
| 205 | }; | ||
| 206 | |||
| 207 | static int acpi_ec_sbs_access(struct acpi_sbs *sbs, u16 addr, | ||
| 208 | char read_write, u8 command, int size, | ||
| 209 | union sbs_rw_data *data); | ||
| 210 | |||
| 211 | /* -------------------------------------------------------------------------- | ||
| 212 | SMBus Communication | ||
| 213 | -------------------------------------------------------------------------- */ | ||
| 214 | |||
| 215 | static int acpi_ec_sbs_read(struct acpi_sbs *sbs, u8 address, u8 * data) | ||
| 216 | { | ||
| 217 | u8 val; | ||
| 218 | int err; | ||
| 219 | |||
| 220 | err = ec_read(sbs->base + address, &val); | ||
| 221 | if (!err) { | ||
| 222 | *data = val; | ||
| 223 | } | ||
| 224 | xmsleep(ACPI_EC_SMB_TRANSACTION_SLEEP); | ||
| 225 | return (err); | ||
| 226 | } | ||
| 227 | |||
| 228 | static int acpi_ec_sbs_write(struct acpi_sbs *sbs, u8 address, u8 data) | ||
| 229 | { | ||
| 230 | int err; | ||
| 231 | |||
| 232 | err = ec_write(sbs->base + address, data); | ||
| 233 | return (err); | ||
| 234 | } | ||
| 235 | |||
| 236 | static int | ||
| 237 | acpi_ec_sbs_access(struct acpi_sbs *sbs, u16 addr, | ||
| 238 | char read_write, u8 command, int size, | ||
| 239 | union sbs_rw_data *data) | ||
| 240 | { | ||
| 241 | unsigned char protocol, len = 0, temp[2] = { 0, 0 }; | ||
| 242 | int i; | ||
| 243 | |||
| 244 | if (read_write == ACPI_SBS_SMBUS_READ) { | ||
| 245 | protocol = ACPI_EC_SMB_PRTCL_READ; | ||
| 246 | } else { | ||
| 247 | protocol = ACPI_EC_SMB_PRTCL_WRITE; | ||
| 248 | } | ||
| 249 | |||
| 250 | switch (size) { | ||
| 251 | |||
| 252 | case ACPI_SBS_WORD_DATA: | ||
| 253 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_CMD, command); | ||
| 254 | if (read_write == ACPI_SBS_SMBUS_WRITE) { | ||
| 255 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA, data->word); | ||
| 256 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA + 1, | ||
| 257 | data->word >> 8); | ||
| 258 | } | ||
| 259 | protocol |= ACPI_EC_SMB_PRTCL_WORD_DATA; | ||
| 260 | break; | ||
| 261 | case ACPI_SBS_BLOCK_DATA: | ||
| 262 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_CMD, command); | ||
| 263 | if (read_write == ACPI_SBS_SMBUS_WRITE) { | ||
| 264 | len = min_t(u8, data->block[0], 32); | ||
| 265 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_BCNT, len); | ||
| 266 | for (i = 0; i < len; i++) | ||
| 267 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA + i, | ||
| 268 | data->block[i + 1]); | ||
| 269 | } | ||
| 270 | protocol |= ACPI_EC_SMB_PRTCL_BLOCK_DATA; | ||
| 271 | break; | ||
| 272 | default: | ||
| 273 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 274 | "unsupported transaction %d", size)); | ||
| 275 | return (-1); | ||
| 276 | } | ||
| 277 | |||
| 278 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_ADDR, addr << 1); | ||
| 279 | acpi_ec_sbs_write(sbs, ACPI_EC_SMB_PRTCL, protocol); | ||
| 280 | |||
| 281 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp); | ||
| 282 | |||
| 283 | if (~temp[0] & ACPI_EC_SMB_STS_DONE) { | ||
| 284 | xmsleep(ACPI_EC_SMB_ACCESS_SLEEP1); | ||
| 285 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp); | ||
| 286 | } | ||
| 287 | if (~temp[0] & ACPI_EC_SMB_STS_DONE) { | ||
| 288 | xmsleep(ACPI_EC_SMB_ACCESS_SLEEP2); | ||
| 289 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp); | ||
| 290 | } | ||
| 291 | if ((~temp[0] & ACPI_EC_SMB_STS_DONE) | ||
| 292 | || (temp[0] & ACPI_EC_SMB_STS_STATUS)) { | ||
| 293 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 294 | "transaction %d error", size)); | ||
| 295 | return (-1); | ||
| 296 | } | ||
| 297 | |||
| 298 | if (read_write == ACPI_SBS_SMBUS_WRITE) { | ||
| 299 | return (0); | ||
| 300 | } | ||
| 301 | |||
| 302 | switch (size) { | ||
| 303 | |||
| 304 | case ACPI_SBS_WORD_DATA: | ||
| 305 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA, temp); | ||
| 306 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA + 1, temp + 1); | ||
| 307 | data->word = (temp[1] << 8) | temp[0]; | ||
| 308 | break; | ||
| 309 | |||
| 310 | case ACPI_SBS_BLOCK_DATA: | ||
| 311 | len = 0; | ||
| 312 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_BCNT, &len); | ||
| 313 | len = min_t(u8, len, 32); | ||
| 314 | for (i = 0; i < len; i++) | ||
| 315 | acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA + i, | ||
| 316 | data->block + i + 1); | ||
| 317 | data->block[0] = len; | ||
| 318 | break; | ||
| 319 | default: | ||
| 320 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 321 | "unsupported transaction %d", size)); | ||
| 322 | return (-1); | ||
| 323 | } | ||
| 324 | |||
| 325 | return (0); | ||
| 326 | } | ||
| 327 | |||
| 328 | static int | ||
| 329 | acpi_sbs_read_word(struct acpi_sbs *sbs, int addr, int func, u16 * word) | ||
| 330 | { | ||
| 331 | union sbs_rw_data data; | ||
| 332 | int result = 0; | ||
| 333 | |||
| 334 | result = acpi_ec_sbs_access(sbs, addr, | ||
| 335 | ACPI_SBS_SMBUS_READ, func, | ||
| 336 | ACPI_SBS_WORD_DATA, &data); | ||
| 337 | if (result) { | ||
| 338 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 339 | "acpi_ec_sbs_access() failed")); | ||
| 340 | } else { | ||
| 341 | *word = data.word; | ||
| 342 | } | ||
| 343 | |||
| 344 | return result; | ||
| 345 | } | ||
| 346 | |||
| 347 | static int | ||
| 348 | acpi_sbs_read_str(struct acpi_sbs *sbs, int addr, int func, char *str) | ||
| 349 | { | ||
| 350 | union sbs_rw_data data; | ||
| 351 | int result = 0; | ||
| 352 | |||
| 353 | result = acpi_ec_sbs_access(sbs, addr, | ||
| 354 | ACPI_SBS_SMBUS_READ, func, | ||
| 355 | ACPI_SBS_BLOCK_DATA, &data); | ||
| 356 | if (result) { | ||
| 357 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 358 | "acpi_ec_sbs_access() failed")); | ||
| 359 | } else { | ||
| 360 | strncpy(str, (const char *)data.block + 1, data.block[0]); | ||
| 361 | str[data.block[0]] = 0; | ||
| 362 | } | ||
| 363 | |||
| 364 | return result; | ||
| 365 | } | ||
| 366 | |||
| 367 | static int | ||
| 368 | acpi_sbs_write_word(struct acpi_sbs *sbs, int addr, int func, int word) | ||
| 369 | { | ||
| 370 | union sbs_rw_data data; | ||
| 371 | int result = 0; | ||
| 372 | |||
| 373 | data.word = word; | ||
| 374 | |||
| 375 | result = acpi_ec_sbs_access(sbs, addr, | ||
| 376 | ACPI_SBS_SMBUS_WRITE, func, | ||
| 377 | ACPI_SBS_WORD_DATA, &data); | ||
| 378 | if (result) { | ||
| 379 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | ||
| 380 | "acpi_ec_sbs_access() failed")); | ||
| 381 | } | ||
| 382 | |||
| 383 | return result; | ||
| 384 | } | ||
| 385 | |||
| 386 | static int sbs_zombie(struct acpi_sbs *sbs) | 175 | static int sbs_zombie(struct acpi_sbs *sbs) |
| 387 | { | 176 | { |
| 388 | return (sbs->zombie); | 177 | return (sbs->zombie); |
| @@ -433,11 +222,11 @@ static int acpi_battery_get_present(struct acpi_battery *battery) | |||
| 433 | int result = 0; | 222 | int result = 0; |
| 434 | int is_present = 0; | 223 | int is_present = 0; |
| 435 | 224 | ||
| 436 | result = acpi_sbs_read_word(battery->sbs, | 225 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, |
| 437 | ACPI_SBSM_SMBUS_ADDR, 0x01, &state); | 226 | ACPI_SBSM_SMBUS_ADDR, 0x01, (u8 *)&state); |
| 438 | if (result) { | 227 | if (result) { |
| 439 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 228 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 440 | "acpi_sbs_read_word() failed")); | 229 | "acpi_smbus_read() failed")); |
| 441 | } | 230 | } |
| 442 | if (!result) { | 231 | if (!result) { |
| 443 | is_present = (state & 0x000f) & (1 << battery->id); | 232 | is_present = (state & 0x000f) & (1 << battery->id); |
| @@ -461,19 +250,19 @@ static int acpi_battery_select(struct acpi_battery *battery) | |||
| 461 | * it causes charging to halt on SBSELs */ | 250 | * it causes charging to halt on SBSELs */ |
| 462 | 251 | ||
| 463 | result = | 252 | result = |
| 464 | acpi_sbs_read_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x01, &state); | 253 | acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SBSM_SMBUS_ADDR, 0x01, (u8 *)&state); |
| 465 | if (result) { | 254 | if (result) { |
| 466 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 255 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 467 | "acpi_sbs_read_word() failed")); | 256 | "acpi_smbus_read() failed")); |
| 468 | goto end; | 257 | goto end; |
| 469 | } | 258 | } |
| 470 | 259 | ||
| 471 | foo = (state & 0x0fff) | (1 << (battery->id + 12)); | 260 | foo = (state & 0x0fff) | (1 << (battery->id + 12)); |
| 472 | result = | 261 | result = |
| 473 | acpi_sbs_write_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x01, foo); | 262 | acpi_smbus_write(battery->sbs->hc, SMBUS_WRITE_WORD, ACPI_SBSM_SMBUS_ADDR, 0x01, (u8 *)&foo, 2); |
| 474 | if (result) { | 263 | if (result) { |
| 475 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 264 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 476 | "acpi_sbs_write_word() failed")); | 265 | "acpi_smbus_write() failed")); |
| 477 | goto end; | 266 | goto end; |
| 478 | } | 267 | } |
| 479 | } | 268 | } |
| @@ -487,11 +276,11 @@ static int acpi_sbsm_get_info(struct acpi_sbs *sbs) | |||
| 487 | int result = 0; | 276 | int result = 0; |
| 488 | s16 battery_system_info; | 277 | s16 battery_system_info; |
| 489 | 278 | ||
| 490 | result = acpi_sbs_read_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x04, | 279 | result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBSM_SMBUS_ADDR, 0x04, |
| 491 | &battery_system_info); | 280 | (u8 *)&battery_system_info); |
| 492 | if (result) { | 281 | if (result) { |
| 493 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 282 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 494 | "acpi_sbs_read_word() failed")); | 283 | "acpi_smbus_read() failed")); |
| 495 | goto end; | 284 | goto end; |
| 496 | } | 285 | } |
| 497 | sbs->sbsm_present = 1; | 286 | sbs->sbsm_present = 1; |
| @@ -504,50 +293,49 @@ static int acpi_sbsm_get_info(struct acpi_sbs *sbs) | |||
| 504 | 293 | ||
| 505 | static int acpi_battery_get_info(struct acpi_battery *battery) | 294 | static int acpi_battery_get_info(struct acpi_battery *battery) |
| 506 | { | 295 | { |
| 507 | struct acpi_sbs *sbs = battery->sbs; | ||
| 508 | int result = 0; | 296 | int result = 0; |
| 509 | s16 battery_mode; | 297 | s16 battery_mode; |
| 510 | s16 specification_info; | 298 | s16 specification_info; |
| 511 | 299 | ||
| 512 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x03, | 300 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x03, |
| 513 | &battery_mode); | 301 | (u8 *)&battery_mode); |
| 514 | if (result) { | 302 | if (result) { |
| 515 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 303 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 516 | "acpi_sbs_read_word() failed")); | 304 | "acpi_smbus_read() failed")); |
| 517 | goto end; | 305 | goto end; |
| 518 | } | 306 | } |
| 519 | battery->info.capacity_mode = (battery_mode & 0x8000) >> 15; | 307 | battery->info.capacity_mode = (battery_mode & 0x8000) >> 15; |
| 520 | 308 | ||
| 521 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x10, | 309 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x10, |
| 522 | &battery->info.full_charge_capacity); | 310 | (u8 *)&battery->info.full_charge_capacity); |
| 523 | if (result) { | 311 | if (result) { |
| 524 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 312 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 525 | "acpi_sbs_read_word() failed")); | 313 | "acpi_smbus_read() failed")); |
| 526 | goto end; | 314 | goto end; |
| 527 | } | 315 | } |
| 528 | 316 | ||
| 529 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x18, | 317 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x18, |
| 530 | &battery->info.design_capacity); | 318 | (u8 *)&battery->info.design_capacity); |
| 531 | 319 | ||
| 532 | if (result) { | 320 | if (result) { |
| 533 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 321 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 534 | "acpi_sbs_read_word() failed")); | 322 | "acpi_smbus_read() failed")); |
| 535 | goto end; | 323 | goto end; |
| 536 | } | 324 | } |
| 537 | 325 | ||
| 538 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x19, | 326 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x19, |
| 539 | &battery->info.design_voltage); | 327 | (u8 *)&battery->info.design_voltage); |
| 540 | if (result) { | 328 | if (result) { |
| 541 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 329 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 542 | "acpi_sbs_read_word() failed")); | 330 | "acpi_smbus_read() failed")); |
| 543 | goto end; | 331 | goto end; |
| 544 | } | 332 | } |
| 545 | 333 | ||
| 546 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x1a, | 334 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x1a, |
| 547 | &specification_info); | 335 | (u8 *)&specification_info); |
| 548 | if (result) { | 336 | if (result) { |
| 549 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 337 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 550 | "acpi_sbs_read_word() failed")); | 338 | "acpi_smbus_read() failed")); |
| 551 | goto end; | 339 | goto end; |
| 552 | } | 340 | } |
| 553 | 341 | ||
| @@ -579,32 +367,32 @@ static int acpi_battery_get_info(struct acpi_battery *battery) | |||
| 579 | battery->info.ipscale = 1; | 367 | battery->info.ipscale = 1; |
| 580 | } | 368 | } |
| 581 | 369 | ||
| 582 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x1c, | 370 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x1c, |
| 583 | &battery->info.serial_number); | 371 | (u8 *)&battery->info.serial_number); |
| 584 | if (result) { | 372 | if (result) { |
| 585 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 373 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 586 | "acpi_sbs_read_word() failed")); | 374 | "acpi_smbus_read() failed")); |
| 587 | goto end; | 375 | goto end; |
| 588 | } | 376 | } |
| 589 | 377 | ||
| 590 | result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x20, | 378 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_BLOCK, ACPI_SB_SMBUS_ADDR, 0x20, |
| 591 | battery->info.manufacturer_name); | 379 | (u8 *)battery->info.manufacturer_name); |
| 592 | if (result) { | 380 | if (result) { |
| 593 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 381 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 594 | "acpi_sbs_read_str() failed")); | 382 | "acpi_sbs_read_str() failed")); |
| 595 | goto end; | 383 | goto end; |
| 596 | } | 384 | } |
| 597 | 385 | ||
| 598 | result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x21, | 386 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_BLOCK, ACPI_SB_SMBUS_ADDR, 0x21, |
| 599 | battery->info.device_name); | 387 | (u8 *)battery->info.device_name); |
| 600 | if (result) { | 388 | if (result) { |
| 601 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 389 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 602 | "acpi_sbs_read_str() failed")); | 390 | "acpi_sbs_read_str() failed")); |
| 603 | goto end; | 391 | goto end; |
| 604 | } | 392 | } |
| 605 | 393 | ||
| 606 | result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x22, | 394 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_BLOCK, ACPI_SB_SMBUS_ADDR, 0x22, |
| 607 | battery->info.device_chemistry); | 395 | (u8 *)battery->info.device_chemistry); |
| 608 | if (result) { | 396 | if (result) { |
| 609 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 397 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 610 | "acpi_sbs_read_str() failed")); | 398 | "acpi_sbs_read_str() failed")); |
| @@ -617,38 +405,37 @@ static int acpi_battery_get_info(struct acpi_battery *battery) | |||
| 617 | 405 | ||
| 618 | static int acpi_battery_get_state(struct acpi_battery *battery) | 406 | static int acpi_battery_get_state(struct acpi_battery *battery) |
| 619 | { | 407 | { |
| 620 | struct acpi_sbs *sbs = battery->sbs; | ||
| 621 | int result = 0; | 408 | int result = 0; |
| 622 | 409 | ||
| 623 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x09, | 410 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x09, |
| 624 | &battery->state.voltage); | 411 | (u8 *)&battery->state.voltage); |
| 625 | if (result) { | 412 | if (result) { |
| 626 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 413 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 627 | "acpi_sbs_read_word() failed")); | 414 | "acpi_smbus_read() failed")); |
| 628 | goto end; | 415 | goto end; |
| 629 | } | 416 | } |
| 630 | 417 | ||
| 631 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x0a, | 418 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x0a, |
| 632 | &battery->state.amperage); | 419 | (u8 *)&battery->state.amperage); |
| 633 | if (result) { | 420 | if (result) { |
| 634 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 421 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 635 | "acpi_sbs_read_word() failed")); | 422 | "acpi_smbus_read() failed")); |
| 636 | goto end; | 423 | goto end; |
| 637 | } | 424 | } |
| 638 | 425 | ||
| 639 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x0f, | 426 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x0f, |
| 640 | &battery->state.remaining_capacity); | 427 | (u8 *)&battery->state.remaining_capacity); |
| 641 | if (result) { | 428 | if (result) { |
| 642 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 429 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 643 | "acpi_sbs_read_word() failed")); | 430 | "acpi_smbus_read() failed")); |
| 644 | goto end; | 431 | goto end; |
| 645 | } | 432 | } |
| 646 | 433 | ||
| 647 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x16, | 434 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x16, |
| 648 | &battery->state.battery_state); | 435 | (u8 *)&battery->state.battery_state); |
| 649 | if (result) { | 436 | if (result) { |
| 650 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 437 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 651 | "acpi_sbs_read_word() failed")); | 438 | "acpi_smbus_read() failed")); |
| 652 | goto end; | 439 | goto end; |
| 653 | } | 440 | } |
| 654 | 441 | ||
| @@ -658,14 +445,13 @@ static int acpi_battery_get_state(struct acpi_battery *battery) | |||
| 658 | 445 | ||
| 659 | static int acpi_battery_get_alarm(struct acpi_battery *battery) | 446 | static int acpi_battery_get_alarm(struct acpi_battery *battery) |
| 660 | { | 447 | { |
| 661 | struct acpi_sbs *sbs = battery->sbs; | ||
| 662 | int result = 0; | 448 | int result = 0; |
| 663 | 449 | ||
| 664 | result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01, | 450 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x01, |
| 665 | &battery->alarm.remaining_capacity); | 451 | (u8 *)&battery->alarm.remaining_capacity); |
| 666 | if (result) { | 452 | if (result) { |
| 667 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 453 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 668 | "acpi_sbs_read_word() failed")); | 454 | "acpi_smbus_read() failed")); |
| 669 | goto end; | 455 | goto end; |
| 670 | } | 456 | } |
| 671 | 457 | ||
| @@ -677,7 +463,6 @@ static int acpi_battery_get_alarm(struct acpi_battery *battery) | |||
| 677 | static int acpi_battery_set_alarm(struct acpi_battery *battery, | 463 | static int acpi_battery_set_alarm(struct acpi_battery *battery, |
| 678 | unsigned long alarm) | 464 | unsigned long alarm) |
| 679 | { | 465 | { |
| 680 | struct acpi_sbs *sbs = battery->sbs; | ||
| 681 | int result = 0; | 466 | int result = 0; |
| 682 | s16 battery_mode; | 467 | s16 battery_mode; |
| 683 | int foo; | 468 | int foo; |
| @@ -693,29 +478,30 @@ static int acpi_battery_set_alarm(struct acpi_battery *battery, | |||
| 693 | 478 | ||
| 694 | if (alarm > 0) { | 479 | if (alarm > 0) { |
| 695 | result = | 480 | result = |
| 696 | acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x03, | 481 | acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x03, |
| 697 | &battery_mode); | 482 | (u8 *)&battery_mode); |
| 698 | if (result) { | 483 | if (result) { |
| 699 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 484 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 700 | "acpi_sbs_read_word() failed")); | 485 | "acpi_smbus_read() failed")); |
| 701 | goto end; | 486 | goto end; |
| 702 | } | 487 | } |
| 703 | 488 | ||
| 489 | battery_mode &= 0xbfff; | ||
| 704 | result = | 490 | result = |
| 705 | acpi_sbs_write_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01, | 491 | acpi_smbus_write(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x01, |
| 706 | battery_mode & 0xbfff); | 492 | (u8 *)&battery_mode, 2); |
| 707 | if (result) { | 493 | if (result) { |
| 708 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 494 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 709 | "acpi_sbs_write_word() failed")); | 495 | "acpi_smbus_write() failed")); |
| 710 | goto end; | 496 | goto end; |
| 711 | } | 497 | } |
| 712 | } | 498 | } |
| 713 | 499 | ||
| 714 | foo = alarm / (battery->info.capacity_mode ? 10 : 1); | 500 | foo = alarm / (battery->info.capacity_mode ? 10 : 1); |
| 715 | result = acpi_sbs_write_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01, foo); | 501 | result = acpi_smbus_write(battery->sbs->hc, SMBUS_READ_WORD, ACPI_SB_SMBUS_ADDR, 0x01, (u8 *)&foo, 2); |
| 716 | if (result) { | 502 | if (result) { |
| 717 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 503 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 718 | "acpi_sbs_write_word() failed")); | 504 | "acpi_smbus_write() failed")); |
| 719 | goto end; | 505 | goto end; |
| 720 | } | 506 | } |
| 721 | 507 | ||
| @@ -726,7 +512,6 @@ static int acpi_battery_set_alarm(struct acpi_battery *battery, | |||
| 726 | 512 | ||
| 727 | static int acpi_battery_set_mode(struct acpi_battery *battery) | 513 | static int acpi_battery_set_mode(struct acpi_battery *battery) |
| 728 | { | 514 | { |
| 729 | struct acpi_sbs *sbs = battery->sbs; | ||
| 730 | int result = 0; | 515 | int result = 0; |
| 731 | s16 battery_mode; | 516 | s16 battery_mode; |
| 732 | 517 | ||
| @@ -734,11 +519,11 @@ static int acpi_battery_set_mode(struct acpi_battery *battery) | |||
| 734 | goto end; | 519 | goto end; |
| 735 | } | 520 | } |
| 736 | 521 | ||
| 737 | result = acpi_sbs_read_word(sbs, | 522 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, |
| 738 | ACPI_SB_SMBUS_ADDR, 0x03, &battery_mode); | 523 | ACPI_SB_SMBUS_ADDR, 0x03, (u8 *)&battery_mode); |
| 739 | if (result) { | 524 | if (result) { |
| 740 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 525 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 741 | "acpi_sbs_read_word() failed")); | 526 | "acpi_smbus_read() failed")); |
| 742 | goto end; | 527 | goto end; |
| 743 | } | 528 | } |
| 744 | 529 | ||
| @@ -747,19 +532,19 @@ static int acpi_battery_set_mode(struct acpi_battery *battery) | |||
| 747 | } else { | 532 | } else { |
| 748 | battery_mode |= 0x8000; | 533 | battery_mode |= 0x8000; |
| 749 | } | 534 | } |
| 750 | result = acpi_sbs_write_word(sbs, | 535 | result = acpi_smbus_write(battery->sbs->hc, SMBUS_READ_WORD, |
| 751 | ACPI_SB_SMBUS_ADDR, 0x03, battery_mode); | 536 | ACPI_SB_SMBUS_ADDR, 0x03, (u8 *)&battery_mode, 2); |
| 752 | if (result) { | 537 | if (result) { |
| 753 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 538 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 754 | "acpi_sbs_write_word() failed")); | 539 | "acpi_smbus_write() failed")); |
| 755 | goto end; | 540 | goto end; |
| 756 | } | 541 | } |
| 757 | 542 | ||
| 758 | result = acpi_sbs_read_word(sbs, | 543 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, |
| 759 | ACPI_SB_SMBUS_ADDR, 0x03, &battery_mode); | 544 | ACPI_SB_SMBUS_ADDR, 0x03, (u8 *)&battery_mode); |
| 760 | if (result) { | 545 | if (result) { |
| 761 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 546 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 762 | "acpi_sbs_read_word() failed")); | 547 | "acpi_smbus_read() failed")); |
| 763 | goto end; | 548 | goto end; |
| 764 | } | 549 | } |
| 765 | 550 | ||
| @@ -815,12 +600,12 @@ static int acpi_ac_get_present(struct acpi_sbs *sbs) | |||
| 815 | int result = 0; | 600 | int result = 0; |
| 816 | s16 charger_status; | 601 | s16 charger_status; |
| 817 | 602 | ||
| 818 | result = acpi_sbs_read_word(sbs, ACPI_SBC_SMBUS_ADDR, 0x13, | 603 | result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBC_SMBUS_ADDR, 0x13, |
| 819 | &charger_status); | 604 | (u8 *)&charger_status); |
| 820 | 605 | ||
| 821 | if (result) { | 606 | if (result) { |
| 822 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, | 607 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, |
| 823 | "acpi_sbs_read_word() failed")); | 608 | "acpi_smbus_read() failed")); |
| 824 | goto end; | 609 | goto end; |
| 825 | } | 610 | } |
| 826 | 611 | ||
| @@ -1614,15 +1399,6 @@ static int acpi_sbs_add(struct acpi_device *device) | |||
| 1614 | struct acpi_sbs *sbs = NULL; | 1399 | struct acpi_sbs *sbs = NULL; |
| 1615 | int result = 0, remove_result = 0; | 1400 | int result = 0, remove_result = 0; |
| 1616 | int id; | 1401 | int id; |
| 1617 | acpi_status status = AE_OK; | ||
| 1618 | unsigned long val; | ||
| 1619 | |||
| 1620 | status = | ||
| 1621 | acpi_evaluate_integer(device->handle, "_EC", NULL, &val); | ||
| 1622 | if (ACPI_FAILURE(status)) { | ||
| 1623 | ACPI_EXCEPTION((AE_INFO, AE_ERROR, "Error obtaining _EC")); | ||
| 1624 | return -EIO; | ||
| 1625 | } | ||
| 1626 | 1402 | ||
| 1627 | sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL); | 1403 | sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL); |
| 1628 | if (!sbs) { | 1404 | if (!sbs) { |
| @@ -1635,8 +1411,8 @@ static int acpi_sbs_add(struct acpi_device *device) | |||
| 1635 | 1411 | ||
| 1636 | sbs_mutex_lock(sbs); | 1412 | sbs_mutex_lock(sbs); |
| 1637 | 1413 | ||
| 1638 | sbs->base = 0xff & (val >> 8); | ||
| 1639 | sbs->device = device; | 1414 | sbs->device = device; |
| 1415 | sbs->hc = acpi_driver_data(device->parent); | ||
| 1640 | 1416 | ||
| 1641 | strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME); | 1417 | strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME); |
| 1642 | strcpy(acpi_device_class(device), ACPI_SBS_CLASS); | 1418 | strcpy(acpi_device_class(device), ACPI_SBS_CLASS); |
diff --git a/drivers/acpi/sbshc.c b/drivers/acpi/sbshc.c new file mode 100644 index 000000000000..046d7c3ed356 --- /dev/null +++ b/drivers/acpi/sbshc.c | |||
| @@ -0,0 +1,309 @@ | |||
| 1 | /* | ||
| 2 | * SMBus driver for ACPI Embedded Controller (v0.1) | ||
| 3 | * | ||
| 4 | * Copyright (c) 2007 Alexey Starikovskiy | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify | ||
| 7 | * it under the terms of the GNU General Public License as published by | ||
| 8 | * the Free Software Foundation version 2. | ||
| 9 | */ | ||
| 10 | |||
| 11 | #include <acpi/acpi_bus.h> | ||
| 12 | #include <acpi/acpi_drivers.h> | ||
| 13 | #include <acpi/actypes.h> | ||
| 14 | #include <linux/wait.h> | ||
| 15 | #include <linux/delay.h> | ||
| 16 | #include <linux/interrupt.h> | ||
| 17 | #include "sbshc.h" | ||
| 18 | |||
| 19 | #define ACPI_SMB_HC_CLASS "smbus_host_controller" | ||
| 20 | #define ACPI_SMB_HC_DEVICE_NAME "ACPI SMBus HC" | ||
| 21 | |||
| 22 | struct acpi_smb_hc { | ||
| 23 | struct acpi_ec *ec; | ||
| 24 | struct mutex lock; | ||
| 25 | wait_queue_head_t wait; | ||
| 26 | u8 offset; | ||
| 27 | u8 query_bit; | ||
| 28 | smbus_alarm_callback callback; | ||
| 29 | void *context; | ||
| 30 | }; | ||
| 31 | |||
| 32 | static int acpi_smbus_hc_add(struct acpi_device *device); | ||
| 33 | static int acpi_smbus_hc_remove(struct acpi_device *device, int type); | ||
| 34 | |||
| 35 | static const struct acpi_device_id sbs_device_ids[] = { | ||
| 36 | {"ACPI0001", 0}, | ||
| 37 | {"ACPI0005", 0}, | ||
| 38 | {"", 0}, | ||
| 39 | }; | ||
| 40 | |||
| 41 | MODULE_DEVICE_TABLE(acpi, sbs_device_ids); | ||
| 42 | |||
| 43 | static struct acpi_driver acpi_smb_hc_driver = { | ||
| 44 | .name = "smbus_hc", | ||
| 45 | .class = ACPI_SMB_HC_CLASS, | ||
| 46 | .ids = sbs_device_ids, | ||
| 47 | .ops = { | ||
| 48 | .add = acpi_smbus_hc_add, | ||
| 49 | .remove = acpi_smbus_hc_remove, | ||
| 50 | }, | ||
| 51 | }; | ||
| 52 | |||
| 53 | union acpi_smb_status { | ||
| 54 | u8 raw; | ||
| 55 | struct { | ||
| 56 | u8 status:5; | ||
| 57 | u8 reserved:1; | ||
| 58 | u8 alarm:1; | ||
| 59 | u8 done:1; | ||
| 60 | } fields; | ||
| 61 | }; | ||
| 62 | |||
| 63 | enum acpi_smb_status_codes { | ||
| 64 | SMBUS_OK = 0, | ||
| 65 | SMBUS_UNKNOWN_FAILURE = 0x07, | ||
| 66 | SMBUS_DEVICE_ADDRESS_NACK = 0x10, | ||
| 67 | SMBUS_DEVICE_ERROR = 0x11, | ||
| 68 | SMBUS_DEVICE_COMMAND_ACCESS_DENIED = 0x12, | ||
| 69 | SMBUS_UNKNOWN_ERROR = 0x13, | ||
| 70 | SMBUS_DEVICE_ACCESS_DENIED = 0x17, | ||
| 71 | SMBUS_TIMEOUT = 0x18, | ||
| 72 | SMBUS_HOST_UNSUPPORTED_PROTOCOL = 0x19, | ||
| 73 | SMBUS_BUSY = 0x1a, | ||
| 74 | SMBUS_PEC_ERROR = 0x1f, | ||
| 75 | }; | ||
| 76 | |||
| 77 | enum acpi_smb_offset { | ||
| 78 | ACPI_SMB_PROTOCOL = 0, /* protocol, PEC */ | ||
| 79 | ACPI_SMB_STATUS = 1, /* status */ | ||
| 80 | ACPI_SMB_ADDRESS = 2, /* address */ | ||
| 81 | ACPI_SMB_COMMAND = 3, /* command */ | ||
| 82 | ACPI_SMB_DATA = 4, /* 32 data registers */ | ||
| 83 | ACPI_SMB_BLOCK_COUNT = 0x24, /* number of data bytes */ | ||
| 84 | ACPI_SMB_ALARM_ADDRESS = 0x25, /* alarm address */ | ||
| 85 | ACPI_SMB_ALARM_DATA = 0x26, /* 2 bytes alarm data */ | ||
| 86 | }; | ||
| 87 | |||
| 88 | static inline int smb_hc_read(struct acpi_smb_hc *hc, u8 address, u8 *data) | ||
| 89 | { | ||
| 90 | return ec_read(hc->offset + address, data); | ||
| 91 | } | ||
| 92 | |||
| 93 | static inline int smb_hc_write(struct acpi_smb_hc *hc, u8 address, u8 data) | ||
| 94 | { | ||
| 95 | return ec_write(hc->offset + address, data); | ||
| 96 | } | ||
| 97 | |||
| 98 | static inline int smb_check_done(struct acpi_smb_hc *hc) | ||
| 99 | { | ||
| 100 | union acpi_smb_status status = {.raw = 0}; | ||
| 101 | smb_hc_read(hc, ACPI_SMB_STATUS, &status.raw); | ||
| 102 | return status.fields.done && (status.fields.status == SMBUS_OK); | ||
| 103 | } | ||
| 104 | |||
| 105 | static int wait_transaction_complete(struct acpi_smb_hc *hc, int timeout) | ||
| 106 | { | ||
| 107 | if (wait_event_timeout(hc->wait, smb_check_done(hc), | ||
| 108 | msecs_to_jiffies(timeout))) | ||
| 109 | return 0; | ||
| 110 | else | ||
| 111 | return -ETIME; | ||
| 112 | } | ||
| 113 | |||
| 114 | int acpi_smbus_transaction(struct acpi_smb_hc *hc, u8 protocol, u8 address, | ||
| 115 | u8 command, u8 *data, u8 length) | ||
| 116 | { | ||
| 117 | int ret = -EFAULT, i; | ||
| 118 | u8 temp, sz = 0; | ||
| 119 | |||
| 120 | mutex_lock(&hc->lock); | ||
| 121 | if (smb_hc_read(hc, ACPI_SMB_PROTOCOL, &temp)) | ||
| 122 | goto end; | ||
| 123 | if (temp) { | ||
| 124 | ret = -EBUSY; | ||
| 125 | goto end; | ||
| 126 | } | ||
| 127 | smb_hc_write(hc, ACPI_SMB_COMMAND, command); | ||
| 128 | smb_hc_write(hc, ACPI_SMB_COMMAND, command); | ||
| 129 | if (!(protocol & 0x01)) { | ||
| 130 | smb_hc_write(hc, ACPI_SMB_BLOCK_COUNT, length); | ||
| 131 | for (i = 0; i < length; ++i) | ||
| 132 | smb_hc_write(hc, ACPI_SMB_DATA + i, data[i]); | ||
| 133 | } | ||
| 134 | smb_hc_write(hc, ACPI_SMB_ADDRESS, address << 1); | ||
| 135 | smb_hc_write(hc, ACPI_SMB_PROTOCOL, protocol); | ||
| 136 | /* | ||
| 137 | * Wait for completion. Save the status code, data size, | ||
| 138 | * and data into the return package (if required by the protocol). | ||
| 139 | */ | ||
| 140 | ret = wait_transaction_complete(hc, 1000); | ||
| 141 | if (ret || !(protocol & 0x01)) | ||
| 142 | goto end; | ||
| 143 | switch (protocol) { | ||
| 144 | case SMBUS_RECEIVE_BYTE: | ||
| 145 | case SMBUS_READ_BYTE: | ||
| 146 | sz = 1; | ||
| 147 | break; | ||
| 148 | case SMBUS_READ_WORD: | ||
| 149 | sz = 2; | ||
| 150 | break; | ||
| 151 | case SMBUS_READ_BLOCK: | ||
| 152 | if (smb_hc_read(hc, ACPI_SMB_BLOCK_COUNT, &sz)) { | ||
| 153 | ret = -EFAULT; | ||
| 154 | goto end; | ||
| 155 | } | ||
| 156 | sz &= 0x1f; | ||
| 157 | break; | ||
| 158 | } | ||
| 159 | for (i = 0; i < sz; ++i) | ||
| 160 | smb_hc_read(hc, ACPI_SMB_DATA + i, &data[i]); | ||
| 161 | end: | ||
| 162 | mutex_unlock(&hc->lock); | ||
| 163 | return ret; | ||
| 164 | } | ||
| 165 | |||
| 166 | int acpi_smbus_read(struct acpi_smb_hc *hc, u8 protocol, u8 address, | ||
| 167 | u8 command, u8 *data) | ||
| 168 | { | ||
| 169 | return acpi_smbus_transaction(hc, protocol, address, command, data, 0); | ||
| 170 | } | ||
| 171 | |||
| 172 | EXPORT_SYMBOL_GPL(acpi_smbus_read); | ||
| 173 | |||
| 174 | int acpi_smbus_write(struct acpi_smb_hc *hc, u8 protocol, u8 address, | ||
| 175 | u8 command, u8 *data, u8 length) | ||
| 176 | { | ||
| 177 | return acpi_smbus_transaction(hc, protocol, address, command, data, length); | ||
| 178 | } | ||
| 179 | |||
| 180 | EXPORT_SYMBOL_GPL(acpi_smbus_write); | ||
| 181 | |||
| 182 | int acpi_smbus_register_callback(struct acpi_smb_hc *hc, | ||
| 183 | smbus_alarm_callback callback, void *context) | ||
| 184 | { | ||
| 185 | mutex_lock(&hc->lock); | ||
| 186 | hc->callback = callback; | ||
| 187 | hc->context = context; | ||
| 188 | mutex_unlock(&hc->lock); | ||
| 189 | return 0; | ||
| 190 | } | ||
| 191 | |||
| 192 | EXPORT_SYMBOL_GPL(acpi_smbus_register_callback); | ||
| 193 | |||
| 194 | int acpi_smbus_unregister_callback(struct acpi_smb_hc *hc) | ||
| 195 | { | ||
| 196 | mutex_lock(&hc->lock); | ||
| 197 | hc->callback = NULL; | ||
| 198 | hc->context = NULL; | ||
| 199 | mutex_unlock(&hc->lock); | ||
| 200 | return 0; | ||
| 201 | } | ||
| 202 | |||
| 203 | EXPORT_SYMBOL_GPL(acpi_smbus_unregister_callback); | ||
| 204 | |||
| 205 | static void acpi_smbus_callback(void *context) | ||
| 206 | { | ||
| 207 | struct acpi_smb_hc *hc = context; | ||
| 208 | |||
| 209 | if (hc->callback) | ||
| 210 | hc->callback(hc->context); | ||
| 211 | } | ||
| 212 | |||
| 213 | static int smbus_alarm(void *context) | ||
| 214 | { | ||
| 215 | struct acpi_smb_hc *hc = context; | ||
| 216 | union acpi_smb_status status; | ||
| 217 | if (smb_hc_read(hc, ACPI_SMB_STATUS, &status.raw)) | ||
| 218 | return 0; | ||
| 219 | /* Check if it is only a completion notify */ | ||
| 220 | if (status.fields.done) | ||
| 221 | wake_up(&hc->wait); | ||
| 222 | if (!status.fields.alarm) | ||
| 223 | return 0; | ||
| 224 | mutex_lock(&hc->lock); | ||
| 225 | smb_hc_write(hc, ACPI_SMB_STATUS, status.raw); | ||
| 226 | if (hc->callback) | ||
| 227 | acpi_os_execute(OSL_GPE_HANDLER, acpi_smbus_callback, hc); | ||
| 228 | mutex_unlock(&hc->lock); | ||
| 229 | return 0; | ||
| 230 | } | ||
| 231 | |||
| 232 | typedef int (*acpi_ec_query_func) (void *data); | ||
| 233 | |||
| 234 | extern int acpi_ec_add_query_handler(struct acpi_ec *ec, u8 query_bit, | ||
| 235 | acpi_handle handle, acpi_ec_query_func func, | ||
| 236 | void *data); | ||
| 237 | |||
| 238 | static int acpi_smbus_hc_add(struct acpi_device *device) | ||
| 239 | { | ||
| 240 | int status; | ||
| 241 | unsigned long val; | ||
| 242 | struct acpi_smb_hc *hc; | ||
| 243 | |||
| 244 | if (!device) | ||
| 245 | return -EINVAL; | ||
| 246 | |||
| 247 | status = acpi_evaluate_integer(device->handle, "_EC", NULL, &val); | ||
| 248 | if (ACPI_FAILURE(status)) { | ||
| 249 | printk(KERN_ERR PREFIX "error obtaining _EC.\n"); | ||
| 250 | return -EIO; | ||
| 251 | } | ||
| 252 | |||
| 253 | strcpy(acpi_device_name(device), ACPI_SMB_HC_DEVICE_NAME); | ||
| 254 | strcpy(acpi_device_class(device), ACPI_SMB_HC_CLASS); | ||
| 255 | |||
| 256 | hc = kzalloc(sizeof(struct acpi_smb_hc), GFP_KERNEL); | ||
| 257 | if (!hc) | ||
| 258 | return -ENOMEM; | ||
| 259 | mutex_init(&hc->lock); | ||
| 260 | init_waitqueue_head(&hc->wait); | ||
| 261 | |||
| 262 | hc->ec = acpi_driver_data(device->parent); | ||
| 263 | hc->offset = (val >> 8) & 0xff; | ||
| 264 | hc->query_bit = val & 0xff; | ||
| 265 | acpi_driver_data(device) = hc; | ||
| 266 | |||
| 267 | acpi_ec_add_query_handler(hc->ec, hc->query_bit, NULL, smbus_alarm, hc); | ||
| 268 | printk(KERN_INFO PREFIX "SBS HC: EC = 0x%p, offset = 0x%0x, query_bit = 0x%0x\n", | ||
| 269 | hc->ec, hc->offset, hc->query_bit); | ||
| 270 | |||
| 271 | return 0; | ||
| 272 | } | ||
| 273 | |||
| 274 | extern void acpi_ec_remove_query_handler(struct acpi_ec *ec, u8 query_bit); | ||
| 275 | |||
| 276 | static int acpi_smbus_hc_remove(struct acpi_device *device, int type) | ||
| 277 | { | ||
| 278 | struct acpi_smb_hc *hc; | ||
| 279 | |||
| 280 | if (!device) | ||
| 281 | return -EINVAL; | ||
| 282 | |||
| 283 | hc = acpi_driver_data(device); | ||
| 284 | acpi_ec_remove_query_handler(hc->ec, hc->query_bit); | ||
| 285 | kfree(hc); | ||
| 286 | return 0; | ||
| 287 | } | ||
| 288 | |||
| 289 | static int __init acpi_smb_hc_init(void) | ||
| 290 | { | ||
| 291 | int result; | ||
| 292 | |||
| 293 | result = acpi_bus_register_driver(&acpi_smb_hc_driver); | ||
| 294 | if (result < 0) | ||
| 295 | return -ENODEV; | ||
| 296 | return 0; | ||
| 297 | } | ||
| 298 | |||
| 299 | static void __exit acpi_smb_hc_exit(void) | ||
| 300 | { | ||
| 301 | acpi_bus_unregister_driver(&acpi_smb_hc_driver); | ||
| 302 | } | ||
| 303 | |||
| 304 | module_init(acpi_smb_hc_init); | ||
| 305 | module_exit(acpi_smb_hc_exit); | ||
| 306 | |||
| 307 | MODULE_LICENSE("GPL"); | ||
| 308 | MODULE_AUTHOR("Alexey Starikovskiy"); | ||
| 309 | MODULE_DESCRIPTION("ACPI SMBus HC driver"); | ||
diff --git a/drivers/acpi/sbshc.h b/drivers/acpi/sbshc.h new file mode 100644 index 000000000000..3bda3491a97b --- /dev/null +++ b/drivers/acpi/sbshc.h | |||
| @@ -0,0 +1,27 @@ | |||
| 1 | struct acpi_smb_hc; | ||
| 2 | enum acpi_smb_protocol { | ||
| 3 | SMBUS_WRITE_QUICK = 2, | ||
| 4 | SMBUS_READ_QUICK = 3, | ||
| 5 | SMBUS_SEND_BYTE = 4, | ||
| 6 | SMBUS_RECEIVE_BYTE = 5, | ||
| 7 | SMBUS_WRITE_BYTE = 6, | ||
| 8 | SMBUS_READ_BYTE = 7, | ||
| 9 | SMBUS_WRITE_WORD = 8, | ||
| 10 | SMBUS_READ_WORD = 9, | ||
| 11 | SMBUS_WRITE_BLOCK = 0xa, | ||
| 12 | SMBUS_READ_BLOCK = 0xb, | ||
| 13 | SMBUS_PROCESS_CALL = 0xc, | ||
| 14 | SMBUS_BLOCK_PROCESS_CALL = 0xd, | ||
| 15 | }; | ||
| 16 | |||
| 17 | static const u8 SMBUS_PEC = 0x80; | ||
| 18 | |||
| 19 | typedef void (*smbus_alarm_callback)(void *context); | ||
| 20 | |||
| 21 | extern int acpi_smbus_read(struct acpi_smb_hc *hc, u8 protocol, u8 address, | ||
| 22 | u8 command, u8 * data); | ||
| 23 | extern int acpi_smbus_write(struct acpi_smb_hc *hc, u8 protocol, u8 slave_address, | ||
| 24 | u8 command, u8 * data, u8 length); | ||
| 25 | extern int acpi_smbus_register_callback(struct acpi_smb_hc *hc, | ||
| 26 | smbus_alarm_callback callback, void *context); | ||
| 27 | extern int acpi_smbus_unregister_callback(struct acpi_smb_hc *hc); | ||
