asus_atk0110.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470
  1. /*
  2. * Copyright (C) 2007-2009 Luca Tettamanti <kronos.it@gmail.com>
  3. *
  4. * This file is released under the GPLv2
  5. * See COPYING in the top level directory of the kernel tree.
  6. */
  7. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  8. #include <linux/debugfs.h>
  9. #include <linux/kernel.h>
  10. #include <linux/hwmon.h>
  11. #include <linux/list.h>
  12. #include <linux/module.h>
  13. #include <linux/slab.h>
  14. #include <linux/dmi.h>
  15. #include <linux/jiffies.h>
  16. #include <linux/err.h>
  17. #include <acpi/acpi.h>
  18. #include <acpi/acpixf.h>
  19. #include <acpi/acpi_drivers.h>
  20. #include <acpi/acpi_bus.h>
  21. #define ATK_HID "ATK0110"
  22. static bool new_if;
  23. module_param(new_if, bool, 0);
  24. MODULE_PARM_DESC(new_if, "Override detection heuristic and force the use of the new ATK0110 interface");
  25. static const struct dmi_system_id __initconst atk_force_new_if[] = {
  26. {
  27. /* Old interface has broken MCH temp monitoring */
  28. .ident = "Asus Sabertooth X58",
  29. .matches = {
  30. DMI_MATCH(DMI_BOARD_NAME, "SABERTOOTH X58")
  31. }
  32. }, {
  33. /* Old interface reads the same sensor for fan0 and fan1 */
  34. .ident = "Asus M5A78L",
  35. .matches = {
  36. DMI_MATCH(DMI_BOARD_NAME, "M5A78L")
  37. }
  38. },
  39. { }
  40. };
  41. /*
  42. * Minimum time between readings, enforced in order to avoid
  43. * hogging the CPU.
  44. */
  45. #define CACHE_TIME HZ
  46. #define BOARD_ID "MBIF"
  47. #define METHOD_ENUMERATE "GGRP"
  48. #define METHOD_READ "GITM"
  49. #define METHOD_WRITE "SITM"
  50. #define METHOD_OLD_READ_TMP "RTMP"
  51. #define METHOD_OLD_READ_VLT "RVLT"
  52. #define METHOD_OLD_READ_FAN "RFAN"
  53. #define METHOD_OLD_ENUM_TMP "TSIF"
  54. #define METHOD_OLD_ENUM_VLT "VSIF"
  55. #define METHOD_OLD_ENUM_FAN "FSIF"
  56. #define ATK_MUX_HWMON 0x00000006ULL
  57. #define ATK_MUX_MGMT 0x00000011ULL
  58. #define ATK_CLASS_MASK 0xff000000ULL
  59. #define ATK_CLASS_FREQ_CTL 0x03000000ULL
  60. #define ATK_CLASS_FAN_CTL 0x04000000ULL
  61. #define ATK_CLASS_HWMON 0x06000000ULL
  62. #define ATK_CLASS_MGMT 0x11000000ULL
  63. #define ATK_TYPE_MASK 0x00ff0000ULL
  64. #define HWMON_TYPE_VOLT 0x00020000ULL
  65. #define HWMON_TYPE_TEMP 0x00030000ULL
  66. #define HWMON_TYPE_FAN 0x00040000ULL
  67. #define ATK_ELEMENT_ID_MASK 0x0000ffffULL
  68. #define ATK_EC_ID 0x11060004ULL
  69. enum atk_pack_member {
  70. HWMON_PACK_FLAGS,
  71. HWMON_PACK_NAME,
  72. HWMON_PACK_LIMIT1,
  73. HWMON_PACK_LIMIT2,
  74. HWMON_PACK_ENABLE
  75. };
  76. /* New package format */
  77. #define _HWMON_NEW_PACK_SIZE 7
  78. #define _HWMON_NEW_PACK_FLAGS 0
  79. #define _HWMON_NEW_PACK_NAME 1
  80. #define _HWMON_NEW_PACK_UNK1 2
  81. #define _HWMON_NEW_PACK_UNK2 3
  82. #define _HWMON_NEW_PACK_LIMIT1 4
  83. #define _HWMON_NEW_PACK_LIMIT2 5
  84. #define _HWMON_NEW_PACK_ENABLE 6
  85. /* Old package format */
  86. #define _HWMON_OLD_PACK_SIZE 5
  87. #define _HWMON_OLD_PACK_FLAGS 0
  88. #define _HWMON_OLD_PACK_NAME 1
  89. #define _HWMON_OLD_PACK_LIMIT1 2
  90. #define _HWMON_OLD_PACK_LIMIT2 3
  91. #define _HWMON_OLD_PACK_ENABLE 4
  92. struct atk_data {
  93. struct device *hwmon_dev;
  94. acpi_handle atk_handle;
  95. struct acpi_device *acpi_dev;
  96. bool old_interface;
  97. /* old interface */
  98. acpi_handle rtmp_handle;
  99. acpi_handle rvlt_handle;
  100. acpi_handle rfan_handle;
  101. /* new inteface */
  102. acpi_handle enumerate_handle;
  103. acpi_handle read_handle;
  104. acpi_handle write_handle;
  105. bool disable_ec;
  106. int voltage_count;
  107. int temperature_count;
  108. int fan_count;
  109. struct list_head sensor_list;
  110. struct {
  111. struct dentry *root;
  112. u32 id;
  113. } debugfs;
  114. };
  115. typedef ssize_t (*sysfs_show_func)(struct device *dev,
  116. struct device_attribute *attr, char *buf);
  117. static const struct acpi_device_id atk_ids[] = {
  118. {ATK_HID, 0},
  119. {"", 0},
  120. };
  121. MODULE_DEVICE_TABLE(acpi, atk_ids);
  122. #define ATTR_NAME_SIZE 16 /* Worst case is "tempN_input" */
  123. struct atk_sensor_data {
  124. struct list_head list;
  125. struct atk_data *data;
  126. struct device_attribute label_attr;
  127. struct device_attribute input_attr;
  128. struct device_attribute limit1_attr;
  129. struct device_attribute limit2_attr;
  130. char label_attr_name[ATTR_NAME_SIZE];
  131. char input_attr_name[ATTR_NAME_SIZE];
  132. char limit1_attr_name[ATTR_NAME_SIZE];
  133. char limit2_attr_name[ATTR_NAME_SIZE];
  134. u64 id;
  135. u64 type;
  136. u64 limit1;
  137. u64 limit2;
  138. u64 cached_value;
  139. unsigned long last_updated; /* in jiffies */
  140. bool is_valid;
  141. char const *acpi_name;
  142. };
  143. /*
  144. * Return buffer format:
  145. * [0-3] "value" is valid flag
  146. * [4-7] value
  147. * [8- ] unknown stuff on newer mobos
  148. */
  149. struct atk_acpi_ret_buffer {
  150. u32 flags;
  151. u32 value;
  152. u8 data[];
  153. };
  154. /* Input buffer used for GITM and SITM methods */
  155. struct atk_acpi_input_buf {
  156. u32 id;
  157. u32 param1;
  158. u32 param2;
  159. };
  160. static int atk_add(struct acpi_device *device);
  161. static int atk_remove(struct acpi_device *device, int type);
  162. static void atk_print_sensor(struct atk_data *data, union acpi_object *obj);
  163. static int atk_read_value(struct atk_sensor_data *sensor, u64 *value);
  164. static void atk_free_sensors(struct atk_data *data);
  165. static struct acpi_driver atk_driver = {
  166. .name = ATK_HID,
  167. .class = "hwmon",
  168. .ids = atk_ids,
  169. .ops = {
  170. .add = atk_add,
  171. .remove = atk_remove,
  172. },
  173. };
  174. #define input_to_atk_sensor(attr) \
  175. container_of(attr, struct atk_sensor_data, input_attr)
  176. #define label_to_atk_sensor(attr) \
  177. container_of(attr, struct atk_sensor_data, label_attr)
  178. #define limit1_to_atk_sensor(attr) \
  179. container_of(attr, struct atk_sensor_data, limit1_attr)
  180. #define limit2_to_atk_sensor(attr) \
  181. container_of(attr, struct atk_sensor_data, limit2_attr)
  182. static ssize_t atk_input_show(struct device *dev,
  183. struct device_attribute *attr, char *buf)
  184. {
  185. struct atk_sensor_data *s = input_to_atk_sensor(attr);
  186. u64 value;
  187. int err;
  188. err = atk_read_value(s, &value);
  189. if (err)
  190. return err;
  191. if (s->type == HWMON_TYPE_TEMP)
  192. /* ACPI returns decidegree */
  193. value *= 100;
  194. return sprintf(buf, "%llu\n", value);
  195. }
  196. static ssize_t atk_label_show(struct device *dev,
  197. struct device_attribute *attr, char *buf)
  198. {
  199. struct atk_sensor_data *s = label_to_atk_sensor(attr);
  200. return sprintf(buf, "%s\n", s->acpi_name);
  201. }
  202. static ssize_t atk_limit1_show(struct device *dev,
  203. struct device_attribute *attr, char *buf)
  204. {
  205. struct atk_sensor_data *s = limit1_to_atk_sensor(attr);
  206. u64 value = s->limit1;
  207. if (s->type == HWMON_TYPE_TEMP)
  208. value *= 100;
  209. return sprintf(buf, "%lld\n", value);
  210. }
  211. static ssize_t atk_limit2_show(struct device *dev,
  212. struct device_attribute *attr, char *buf)
  213. {
  214. struct atk_sensor_data *s = limit2_to_atk_sensor(attr);
  215. u64 value = s->limit2;
  216. if (s->type == HWMON_TYPE_TEMP)
  217. value *= 100;
  218. return sprintf(buf, "%lld\n", value);
  219. }
  220. static ssize_t atk_name_show(struct device *dev,
  221. struct device_attribute *attr, char *buf)
  222. {
  223. return sprintf(buf, "atk0110\n");
  224. }
  225. static struct device_attribute atk_name_attr =
  226. __ATTR(name, 0444, atk_name_show, NULL);
  227. static void atk_init_attribute(struct device_attribute *attr, char *name,
  228. sysfs_show_func show)
  229. {
  230. sysfs_attr_init(&attr->attr);
  231. attr->attr.name = name;
  232. attr->attr.mode = 0444;
  233. attr->show = show;
  234. attr->store = NULL;
  235. }
  236. static union acpi_object *atk_get_pack_member(struct atk_data *data,
  237. union acpi_object *pack,
  238. enum atk_pack_member m)
  239. {
  240. bool old_if = data->old_interface;
  241. int offset;
  242. switch (m) {
  243. case HWMON_PACK_FLAGS:
  244. offset = old_if ? _HWMON_OLD_PACK_FLAGS : _HWMON_NEW_PACK_FLAGS;
  245. break;
  246. case HWMON_PACK_NAME:
  247. offset = old_if ? _HWMON_OLD_PACK_NAME : _HWMON_NEW_PACK_NAME;
  248. break;
  249. case HWMON_PACK_LIMIT1:
  250. offset = old_if ? _HWMON_OLD_PACK_LIMIT1 :
  251. _HWMON_NEW_PACK_LIMIT1;
  252. break;
  253. case HWMON_PACK_LIMIT2:
  254. offset = old_if ? _HWMON_OLD_PACK_LIMIT2 :
  255. _HWMON_NEW_PACK_LIMIT2;
  256. break;
  257. case HWMON_PACK_ENABLE:
  258. offset = old_if ? _HWMON_OLD_PACK_ENABLE :
  259. _HWMON_NEW_PACK_ENABLE;
  260. break;
  261. default:
  262. return NULL;
  263. }
  264. return &pack->package.elements[offset];
  265. }
  266. /*
  267. * New package format is:
  268. * - flag (int)
  269. * class - used for de-muxing the request to the correct GITn
  270. * type (volt, temp, fan)
  271. * sensor id |
  272. * sensor id - used for de-muxing the request _inside_ the GITn
  273. * - name (str)
  274. * - unknown (int)
  275. * - unknown (int)
  276. * - limit1 (int)
  277. * - limit2 (int)
  278. * - enable (int)
  279. *
  280. * The old package has the same format but it's missing the two unknown fields.
  281. */
  282. static int validate_hwmon_pack(struct atk_data *data, union acpi_object *obj)
  283. {
  284. struct device *dev = &data->acpi_dev->dev;
  285. union acpi_object *tmp;
  286. bool old_if = data->old_interface;
  287. int const expected_size = old_if ? _HWMON_OLD_PACK_SIZE :
  288. _HWMON_NEW_PACK_SIZE;
  289. if (obj->type != ACPI_TYPE_PACKAGE) {
  290. dev_warn(dev, "Invalid type: %d\n", obj->type);
  291. return -EINVAL;
  292. }
  293. if (obj->package.count != expected_size) {
  294. dev_warn(dev, "Invalid package size: %d, expected: %d\n",
  295. obj->package.count, expected_size);
  296. return -EINVAL;
  297. }
  298. tmp = atk_get_pack_member(data, obj, HWMON_PACK_FLAGS);
  299. if (tmp->type != ACPI_TYPE_INTEGER) {
  300. dev_warn(dev, "Invalid type (flag): %d\n", tmp->type);
  301. return -EINVAL;
  302. }
  303. tmp = atk_get_pack_member(data, obj, HWMON_PACK_NAME);
  304. if (tmp->type != ACPI_TYPE_STRING) {
  305. dev_warn(dev, "Invalid type (name): %d\n", tmp->type);
  306. return -EINVAL;
  307. }
  308. /* Don't check... we don't know what they're useful for anyway */
  309. #if 0
  310. tmp = &obj->package.elements[HWMON_PACK_UNK1];
  311. if (tmp->type != ACPI_TYPE_INTEGER) {
  312. dev_warn(dev, "Invalid type (unk1): %d\n", tmp->type);
  313. return -EINVAL;
  314. }
  315. tmp = &obj->package.elements[HWMON_PACK_UNK2];
  316. if (tmp->type != ACPI_TYPE_INTEGER) {
  317. dev_warn(dev, "Invalid type (unk2): %d\n", tmp->type);
  318. return -EINVAL;
  319. }
  320. #endif
  321. tmp = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT1);
  322. if (tmp->type != ACPI_TYPE_INTEGER) {
  323. dev_warn(dev, "Invalid type (limit1): %d\n", tmp->type);
  324. return -EINVAL;
  325. }
  326. tmp = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT2);
  327. if (tmp->type != ACPI_TYPE_INTEGER) {
  328. dev_warn(dev, "Invalid type (limit2): %d\n", tmp->type);
  329. return -EINVAL;
  330. }
  331. tmp = atk_get_pack_member(data, obj, HWMON_PACK_ENABLE);
  332. if (tmp->type != ACPI_TYPE_INTEGER) {
  333. dev_warn(dev, "Invalid type (enable): %d\n", tmp->type);
  334. return -EINVAL;
  335. }
  336. atk_print_sensor(data, obj);
  337. return 0;
  338. }
  339. #ifdef DEBUG
  340. static char const *atk_sensor_type(union acpi_object *flags)
  341. {
  342. u64 type = flags->integer.value & ATK_TYPE_MASK;
  343. char const *what;
  344. switch (type) {
  345. case HWMON_TYPE_VOLT:
  346. what = "voltage";
  347. break;
  348. case HWMON_TYPE_TEMP:
  349. what = "temperature";
  350. break;
  351. case HWMON_TYPE_FAN:
  352. what = "fan";
  353. break;
  354. default:
  355. what = "unknown";
  356. break;
  357. }
  358. return what;
  359. }
  360. #endif
  361. static void atk_print_sensor(struct atk_data *data, union acpi_object *obj)
  362. {
  363. #ifdef DEBUG
  364. struct device *dev = &data->acpi_dev->dev;
  365. union acpi_object *flags;
  366. union acpi_object *name;
  367. union acpi_object *limit1;
  368. union acpi_object *limit2;
  369. union acpi_object *enable;
  370. char const *what;
  371. flags = atk_get_pack_member(data, obj, HWMON_PACK_FLAGS);
  372. name = atk_get_pack_member(data, obj, HWMON_PACK_NAME);
  373. limit1 = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT1);
  374. limit2 = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT2);
  375. enable = atk_get_pack_member(data, obj, HWMON_PACK_ENABLE);
  376. what = atk_sensor_type(flags);
  377. dev_dbg(dev, "%s: %#llx %s [%llu-%llu] %s\n", what,
  378. flags->integer.value,
  379. name->string.pointer,
  380. limit1->integer.value, limit2->integer.value,
  381. enable->integer.value ? "enabled" : "disabled");
  382. #endif
  383. }
  384. static int atk_read_value_old(struct atk_sensor_data *sensor, u64 *value)
  385. {
  386. struct atk_data *data = sensor->data;
  387. struct device *dev = &data->acpi_dev->dev;
  388. struct acpi_object_list params;
  389. union acpi_object id;
  390. acpi_status status;
  391. acpi_handle method;
  392. switch (sensor->type) {
  393. case HWMON_TYPE_VOLT:
  394. method = data->rvlt_handle;
  395. break;
  396. case HWMON_TYPE_TEMP:
  397. method = data->rtmp_handle;
  398. break;
  399. case HWMON_TYPE_FAN:
  400. method = data->rfan_handle;
  401. break;
  402. default:
  403. return -EINVAL;
  404. }
  405. id.type = ACPI_TYPE_INTEGER;
  406. id.integer.value = sensor->id;
  407. params.count = 1;
  408. params.pointer = &id;
  409. status = acpi_evaluate_integer(method, NULL, &params, value);
  410. if (status != AE_OK) {
  411. dev_warn(dev, "%s: ACPI exception: %s\n", __func__,
  412. acpi_format_exception(status));
  413. return -EIO;
  414. }
  415. return 0;
  416. }
  417. static union acpi_object *atk_ggrp(struct atk_data *data, u16 mux)
  418. {
  419. struct device *dev = &data->acpi_dev->dev;
  420. struct acpi_buffer buf;
  421. acpi_status ret;
  422. struct acpi_object_list params;
  423. union acpi_object id;
  424. union acpi_object *pack;
  425. id.type = ACPI_TYPE_INTEGER;
  426. id.integer.value = mux;
  427. params.count = 1;
  428. params.pointer = &id;
  429. buf.length = ACPI_ALLOCATE_BUFFER;
  430. ret = acpi_evaluate_object(data->enumerate_handle, NULL, &params, &buf);
  431. if (ret != AE_OK) {
  432. dev_err(dev, "GGRP[%#x] ACPI exception: %s\n", mux,
  433. acpi_format_exception(ret));
  434. return ERR_PTR(-EIO);
  435. }
  436. pack = buf.pointer;
  437. if (pack->type != ACPI_TYPE_PACKAGE) {
  438. /* Execution was successful, but the id was not found */
  439. ACPI_FREE(pack);
  440. return ERR_PTR(-ENOENT);
  441. }
  442. if (pack->package.count < 1) {
  443. dev_err(dev, "GGRP[%#x] package is too small\n", mux);
  444. ACPI_FREE(pack);
  445. return ERR_PTR(-EIO);
  446. }
  447. return pack;
  448. }
  449. static union acpi_object *atk_gitm(struct atk_data *data, u64 id)
  450. {
  451. struct device *dev = &data->acpi_dev->dev;
  452. struct atk_acpi_input_buf buf;
  453. union acpi_object tmp;
  454. struct acpi_object_list params;
  455. struct acpi_buffer ret;
  456. union acpi_object *obj;
  457. acpi_status status;
  458. buf.id = id;
  459. buf.param1 = 0;
  460. buf.param2 = 0;
  461. tmp.type = ACPI_TYPE_BUFFER;
  462. tmp.buffer.pointer = (u8 *)&buf;
  463. tmp.buffer.length = sizeof(buf);
  464. params.count = 1;
  465. params.pointer = (void *)&tmp;
  466. ret.length = ACPI_ALLOCATE_BUFFER;
  467. status = acpi_evaluate_object_typed(data->read_handle, NULL, &params,
  468. &ret, ACPI_TYPE_BUFFER);
  469. if (status != AE_OK) {
  470. dev_warn(dev, "GITM[%#llx] ACPI exception: %s\n", id,
  471. acpi_format_exception(status));
  472. return ERR_PTR(-EIO);
  473. }
  474. obj = ret.pointer;
  475. /* Sanity check */
  476. if (obj->buffer.length < 8) {
  477. dev_warn(dev, "Unexpected ASBF length: %u\n",
  478. obj->buffer.length);
  479. ACPI_FREE(obj);
  480. return ERR_PTR(-EIO);
  481. }
  482. return obj;
  483. }
  484. static union acpi_object *atk_sitm(struct atk_data *data,
  485. struct atk_acpi_input_buf *buf)
  486. {
  487. struct device *dev = &data->acpi_dev->dev;
  488. struct acpi_object_list params;
  489. union acpi_object tmp;
  490. struct acpi_buffer ret;
  491. union acpi_object *obj;
  492. acpi_status status;
  493. tmp.type = ACPI_TYPE_BUFFER;
  494. tmp.buffer.pointer = (u8 *)buf;
  495. tmp.buffer.length = sizeof(*buf);
  496. params.count = 1;
  497. params.pointer = &tmp;
  498. ret.length = ACPI_ALLOCATE_BUFFER;
  499. status = acpi_evaluate_object_typed(data->write_handle, NULL, &params,
  500. &ret, ACPI_TYPE_BUFFER);
  501. if (status != AE_OK) {
  502. dev_warn(dev, "SITM[%#x] ACPI exception: %s\n", buf->id,
  503. acpi_format_exception(status));
  504. return ERR_PTR(-EIO);
  505. }
  506. obj = ret.pointer;
  507. /* Sanity check */
  508. if (obj->buffer.length < 8) {
  509. dev_warn(dev, "Unexpected ASBF length: %u\n",
  510. obj->buffer.length);
  511. ACPI_FREE(obj);
  512. return ERR_PTR(-EIO);
  513. }
  514. return obj;
  515. }
  516. static int atk_read_value_new(struct atk_sensor_data *sensor, u64 *value)
  517. {
  518. struct atk_data *data = sensor->data;
  519. struct device *dev = &data->acpi_dev->dev;
  520. union acpi_object *obj;
  521. struct atk_acpi_ret_buffer *buf;
  522. int err = 0;
  523. obj = atk_gitm(data, sensor->id);
  524. if (IS_ERR(obj))
  525. return PTR_ERR(obj);
  526. buf = (struct atk_acpi_ret_buffer *)obj->buffer.pointer;
  527. if (buf->flags == 0) {
  528. /*
  529. * The reading is not valid, possible causes:
  530. * - sensor failure
  531. * - enumeration was FUBAR (and we didn't notice)
  532. */
  533. dev_warn(dev, "Read failed, sensor = %#llx\n", sensor->id);
  534. err = -EIO;
  535. goto out;
  536. }
  537. *value = buf->value;
  538. out:
  539. ACPI_FREE(obj);
  540. return err;
  541. }
  542. static int atk_read_value(struct atk_sensor_data *sensor, u64 *value)
  543. {
  544. int err;
  545. if (!sensor->is_valid ||
  546. time_after(jiffies, sensor->last_updated + CACHE_TIME)) {
  547. if (sensor->data->old_interface)
  548. err = atk_read_value_old(sensor, value);
  549. else
  550. err = atk_read_value_new(sensor, value);
  551. sensor->is_valid = true;
  552. sensor->last_updated = jiffies;
  553. sensor->cached_value = *value;
  554. } else {
  555. *value = sensor->cached_value;
  556. err = 0;
  557. }
  558. return err;
  559. }
  560. #ifdef CONFIG_DEBUG_FS
  561. static int atk_debugfs_gitm_get(void *p, u64 *val)
  562. {
  563. struct atk_data *data = p;
  564. union acpi_object *ret;
  565. struct atk_acpi_ret_buffer *buf;
  566. int err = 0;
  567. if (!data->read_handle)
  568. return -ENODEV;
  569. if (!data->debugfs.id)
  570. return -EINVAL;
  571. ret = atk_gitm(data, data->debugfs.id);
  572. if (IS_ERR(ret))
  573. return PTR_ERR(ret);
  574. buf = (struct atk_acpi_ret_buffer *)ret->buffer.pointer;
  575. if (buf->flags)
  576. *val = buf->value;
  577. else
  578. err = -EIO;
  579. ACPI_FREE(ret);
  580. return err;
  581. }
  582. DEFINE_SIMPLE_ATTRIBUTE(atk_debugfs_gitm,
  583. atk_debugfs_gitm_get,
  584. NULL,
  585. "0x%08llx\n")
  586. static int atk_acpi_print(char *buf, size_t sz, union acpi_object *obj)
  587. {
  588. int ret = 0;
  589. switch (obj->type) {
  590. case ACPI_TYPE_INTEGER:
  591. ret = snprintf(buf, sz, "0x%08llx\n", obj->integer.value);
  592. break;
  593. case ACPI_TYPE_STRING:
  594. ret = snprintf(buf, sz, "%s\n", obj->string.pointer);
  595. break;
  596. }
  597. return ret;
  598. }
  599. static void atk_pack_print(char *buf, size_t sz, union acpi_object *pack)
  600. {
  601. int ret;
  602. int i;
  603. for (i = 0; i < pack->package.count; i++) {
  604. union acpi_object *obj = &pack->package.elements[i];
  605. ret = atk_acpi_print(buf, sz, obj);
  606. if (ret >= sz)
  607. break;
  608. buf += ret;
  609. sz -= ret;
  610. }
  611. }
  612. static int atk_debugfs_ggrp_open(struct inode *inode, struct file *file)
  613. {
  614. struct atk_data *data = inode->i_private;
  615. char *buf = NULL;
  616. union acpi_object *ret;
  617. u8 cls;
  618. int i;
  619. if (!data->enumerate_handle)
  620. return -ENODEV;
  621. if (!data->debugfs.id)
  622. return -EINVAL;
  623. cls = (data->debugfs.id & 0xff000000) >> 24;
  624. ret = atk_ggrp(data, cls);
  625. if (IS_ERR(ret))
  626. return PTR_ERR(ret);
  627. for (i = 0; i < ret->package.count; i++) {
  628. union acpi_object *pack = &ret->package.elements[i];
  629. union acpi_object *id;
  630. if (pack->type != ACPI_TYPE_PACKAGE)
  631. continue;
  632. if (!pack->package.count)
  633. continue;
  634. id = &pack->package.elements[0];
  635. if (id->integer.value == data->debugfs.id) {
  636. /* Print the package */
  637. buf = kzalloc(512, GFP_KERNEL);
  638. if (!buf) {
  639. ACPI_FREE(ret);
  640. return -ENOMEM;
  641. }
  642. atk_pack_print(buf, 512, pack);
  643. break;
  644. }
  645. }
  646. ACPI_FREE(ret);
  647. if (!buf)
  648. return -EINVAL;
  649. file->private_data = buf;
  650. return nonseekable_open(inode, file);
  651. }
  652. static ssize_t atk_debugfs_ggrp_read(struct file *file, char __user *buf,
  653. size_t count, loff_t *pos)
  654. {
  655. char *str = file->private_data;
  656. size_t len = strlen(str);
  657. return simple_read_from_buffer(buf, count, pos, str, len);
  658. }
  659. static int atk_debugfs_ggrp_release(struct inode *inode, struct file *file)
  660. {
  661. kfree(file->private_data);
  662. return 0;
  663. }
  664. static const struct file_operations atk_debugfs_ggrp_fops = {
  665. .read = atk_debugfs_ggrp_read,
  666. .open = atk_debugfs_ggrp_open,
  667. .release = atk_debugfs_ggrp_release,
  668. .llseek = no_llseek,
  669. };
  670. static void atk_debugfs_init(struct atk_data *data)
  671. {
  672. struct dentry *d;
  673. struct dentry *f;
  674. data->debugfs.id = 0;
  675. d = debugfs_create_dir("asus_atk0110", NULL);
  676. if (!d || IS_ERR(d))
  677. return;
  678. f = debugfs_create_x32("id", S_IRUSR | S_IWUSR, d, &data->debugfs.id);
  679. if (!f || IS_ERR(f))
  680. goto cleanup;
  681. f = debugfs_create_file("gitm", S_IRUSR, d, data,
  682. &atk_debugfs_gitm);
  683. if (!f || IS_ERR(f))
  684. goto cleanup;
  685. f = debugfs_create_file("ggrp", S_IRUSR, d, data,
  686. &atk_debugfs_ggrp_fops);
  687. if (!f || IS_ERR(f))
  688. goto cleanup;
  689. data->debugfs.root = d;
  690. return;
  691. cleanup:
  692. debugfs_remove_recursive(d);
  693. }
  694. static void atk_debugfs_cleanup(struct atk_data *data)
  695. {
  696. debugfs_remove_recursive(data->debugfs.root);
  697. }
  698. #else /* CONFIG_DEBUG_FS */
  699. static void atk_debugfs_init(struct atk_data *data)
  700. {
  701. }
  702. static void atk_debugfs_cleanup(struct atk_data *data)
  703. {
  704. }
  705. #endif
  706. static int atk_add_sensor(struct atk_data *data, union acpi_object *obj)
  707. {
  708. struct device *dev = &data->acpi_dev->dev;
  709. union acpi_object *flags;
  710. union acpi_object *name;
  711. union acpi_object *limit1;
  712. union acpi_object *limit2;
  713. union acpi_object *enable;
  714. struct atk_sensor_data *sensor;
  715. char const *base_name;
  716. char const *limit1_name;
  717. char const *limit2_name;
  718. u64 type;
  719. int err;
  720. int *num;
  721. int start;
  722. if (obj->type != ACPI_TYPE_PACKAGE) {
  723. /* wft is this? */
  724. dev_warn(dev, "Unknown type for ACPI object: (%d)\n",
  725. obj->type);
  726. return -EINVAL;
  727. }
  728. err = validate_hwmon_pack(data, obj);
  729. if (err)
  730. return err;
  731. /* Ok, we have a valid hwmon package */
  732. type = atk_get_pack_member(data, obj, HWMON_PACK_FLAGS)->integer.value
  733. & ATK_TYPE_MASK;
  734. switch (type) {
  735. case HWMON_TYPE_VOLT:
  736. base_name = "in";
  737. limit1_name = "min";
  738. limit2_name = "max";
  739. num = &data->voltage_count;
  740. start = 0;
  741. break;
  742. case HWMON_TYPE_TEMP:
  743. base_name = "temp";
  744. limit1_name = "max";
  745. limit2_name = "crit";
  746. num = &data->temperature_count;
  747. start = 1;
  748. break;
  749. case HWMON_TYPE_FAN:
  750. base_name = "fan";
  751. limit1_name = "min";
  752. limit2_name = "max";
  753. num = &data->fan_count;
  754. start = 1;
  755. break;
  756. default:
  757. dev_warn(dev, "Unknown sensor type: %#llx\n", type);
  758. return -EINVAL;
  759. }
  760. enable = atk_get_pack_member(data, obj, HWMON_PACK_ENABLE);
  761. if (!enable->integer.value)
  762. /* sensor is disabled */
  763. return 0;
  764. flags = atk_get_pack_member(data, obj, HWMON_PACK_FLAGS);
  765. name = atk_get_pack_member(data, obj, HWMON_PACK_NAME);
  766. limit1 = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT1);
  767. limit2 = atk_get_pack_member(data, obj, HWMON_PACK_LIMIT2);
  768. sensor = kzalloc(sizeof(*sensor), GFP_KERNEL);
  769. if (!sensor)
  770. return -ENOMEM;
  771. sensor->acpi_name = kstrdup(name->string.pointer, GFP_KERNEL);
  772. if (!sensor->acpi_name) {
  773. err = -ENOMEM;
  774. goto out;
  775. }
  776. INIT_LIST_HEAD(&sensor->list);
  777. sensor->type = type;
  778. sensor->data = data;
  779. sensor->id = flags->integer.value;
  780. sensor->limit1 = limit1->integer.value;
  781. if (data->old_interface)
  782. sensor->limit2 = limit2->integer.value;
  783. else
  784. /* The upper limit is expressed as delta from lower limit */
  785. sensor->limit2 = sensor->limit1 + limit2->integer.value;
  786. snprintf(sensor->input_attr_name, ATTR_NAME_SIZE,
  787. "%s%d_input", base_name, start + *num);
  788. atk_init_attribute(&sensor->input_attr,
  789. sensor->input_attr_name,
  790. atk_input_show);
  791. snprintf(sensor->label_attr_name, ATTR_NAME_SIZE,
  792. "%s%d_label", base_name, start + *num);
  793. atk_init_attribute(&sensor->label_attr,
  794. sensor->label_attr_name,
  795. atk_label_show);
  796. snprintf(sensor->limit1_attr_name, ATTR_NAME_SIZE,
  797. "%s%d_%s", base_name, start + *num, limit1_name);
  798. atk_init_attribute(&sensor->limit1_attr,
  799. sensor->limit1_attr_name,
  800. atk_limit1_show);
  801. snprintf(sensor->limit2_attr_name, ATTR_NAME_SIZE,
  802. "%s%d_%s", base_name, start + *num, limit2_name);
  803. atk_init_attribute(&sensor->limit2_attr,
  804. sensor->limit2_attr_name,
  805. atk_limit2_show);
  806. list_add(&sensor->list, &data->sensor_list);
  807. (*num)++;
  808. return 1;
  809. out:
  810. kfree(sensor);
  811. return err;
  812. }
  813. static int atk_enumerate_old_hwmon(struct atk_data *data)
  814. {
  815. struct device *dev = &data->acpi_dev->dev;
  816. struct acpi_buffer buf;
  817. union acpi_object *pack;
  818. acpi_status status;
  819. int i, ret;
  820. int count = 0;
  821. /* Voltages */
  822. buf.length = ACPI_ALLOCATE_BUFFER;
  823. status = acpi_evaluate_object_typed(data->atk_handle,
  824. METHOD_OLD_ENUM_VLT, NULL, &buf, ACPI_TYPE_PACKAGE);
  825. if (status != AE_OK) {
  826. dev_warn(dev, METHOD_OLD_ENUM_VLT ": ACPI exception: %s\n",
  827. acpi_format_exception(status));
  828. return -ENODEV;
  829. }
  830. pack = buf.pointer;
  831. for (i = 1; i < pack->package.count; i++) {
  832. union acpi_object *obj = &pack->package.elements[i];
  833. ret = atk_add_sensor(data, obj);
  834. if (ret > 0)
  835. count++;
  836. }
  837. ACPI_FREE(buf.pointer);
  838. /* Temperatures */
  839. buf.length = ACPI_ALLOCATE_BUFFER;
  840. status = acpi_evaluate_object_typed(data->atk_handle,
  841. METHOD_OLD_ENUM_TMP, NULL, &buf, ACPI_TYPE_PACKAGE);
  842. if (status != AE_OK) {
  843. dev_warn(dev, METHOD_OLD_ENUM_TMP ": ACPI exception: %s\n",
  844. acpi_format_exception(status));
  845. ret = -ENODEV;
  846. goto cleanup;
  847. }
  848. pack = buf.pointer;
  849. for (i = 1; i < pack->package.count; i++) {
  850. union acpi_object *obj = &pack->package.elements[i];
  851. ret = atk_add_sensor(data, obj);
  852. if (ret > 0)
  853. count++;
  854. }
  855. ACPI_FREE(buf.pointer);
  856. /* Fans */
  857. buf.length = ACPI_ALLOCATE_BUFFER;
  858. status = acpi_evaluate_object_typed(data->atk_handle,
  859. METHOD_OLD_ENUM_FAN, NULL, &buf, ACPI_TYPE_PACKAGE);
  860. if (status != AE_OK) {
  861. dev_warn(dev, METHOD_OLD_ENUM_FAN ": ACPI exception: %s\n",
  862. acpi_format_exception(status));
  863. ret = -ENODEV;
  864. goto cleanup;
  865. }
  866. pack = buf.pointer;
  867. for (i = 1; i < pack->package.count; i++) {
  868. union acpi_object *obj = &pack->package.elements[i];
  869. ret = atk_add_sensor(data, obj);
  870. if (ret > 0)
  871. count++;
  872. }
  873. ACPI_FREE(buf.pointer);
  874. return count;
  875. cleanup:
  876. atk_free_sensors(data);
  877. return ret;
  878. }
  879. static int atk_ec_present(struct atk_data *data)
  880. {
  881. struct device *dev = &data->acpi_dev->dev;
  882. union acpi_object *pack;
  883. union acpi_object *ec;
  884. int ret;
  885. int i;
  886. pack = atk_ggrp(data, ATK_MUX_MGMT);
  887. if (IS_ERR(pack)) {
  888. if (PTR_ERR(pack) == -ENOENT) {
  889. /* The MGMT class does not exists - that's ok */
  890. dev_dbg(dev, "Class %#llx not found\n", ATK_MUX_MGMT);
  891. return 0;
  892. }
  893. return PTR_ERR(pack);
  894. }
  895. /* Search the EC */
  896. ec = NULL;
  897. for (i = 0; i < pack->package.count; i++) {
  898. union acpi_object *obj = &pack->package.elements[i];
  899. union acpi_object *id;
  900. if (obj->type != ACPI_TYPE_PACKAGE)
  901. continue;
  902. id = &obj->package.elements[0];
  903. if (id->type != ACPI_TYPE_INTEGER)
  904. continue;
  905. if (id->integer.value == ATK_EC_ID) {
  906. ec = obj;
  907. break;
  908. }
  909. }
  910. ret = (ec != NULL);
  911. if (!ret)
  912. /* The system has no EC */
  913. dev_dbg(dev, "EC not found\n");
  914. ACPI_FREE(pack);
  915. return ret;
  916. }
  917. static int atk_ec_enabled(struct atk_data *data)
  918. {
  919. struct device *dev = &data->acpi_dev->dev;
  920. union acpi_object *obj;
  921. struct atk_acpi_ret_buffer *buf;
  922. int err;
  923. obj = atk_gitm(data, ATK_EC_ID);
  924. if (IS_ERR(obj)) {
  925. dev_err(dev, "Unable to query EC status\n");
  926. return PTR_ERR(obj);
  927. }
  928. buf = (struct atk_acpi_ret_buffer *)obj->buffer.pointer;
  929. if (buf->flags == 0) {
  930. dev_err(dev, "Unable to query EC status\n");
  931. err = -EIO;
  932. } else {
  933. err = (buf->value != 0);
  934. dev_dbg(dev, "EC is %sabled\n",
  935. err ? "en" : "dis");
  936. }
  937. ACPI_FREE(obj);
  938. return err;
  939. }
  940. static int atk_ec_ctl(struct atk_data *data, int enable)
  941. {
  942. struct device *dev = &data->acpi_dev->dev;
  943. union acpi_object *obj;
  944. struct atk_acpi_input_buf sitm;
  945. struct atk_acpi_ret_buffer *ec_ret;
  946. int err = 0;
  947. sitm.id = ATK_EC_ID;
  948. sitm.param1 = enable;
  949. sitm.param2 = 0;
  950. obj = atk_sitm(data, &sitm);
  951. if (IS_ERR(obj)) {
  952. dev_err(dev, "Failed to %sable the EC\n",
  953. enable ? "en" : "dis");
  954. return PTR_ERR(obj);
  955. }
  956. ec_ret = (struct atk_acpi_ret_buffer *)obj->buffer.pointer;
  957. if (ec_ret->flags == 0) {
  958. dev_err(dev, "Failed to %sable the EC\n",
  959. enable ? "en" : "dis");
  960. err = -EIO;
  961. } else {
  962. dev_info(dev, "EC %sabled\n",
  963. enable ? "en" : "dis");
  964. }
  965. ACPI_FREE(obj);
  966. return err;
  967. }
  968. static int atk_enumerate_new_hwmon(struct atk_data *data)
  969. {
  970. struct device *dev = &data->acpi_dev->dev;
  971. union acpi_object *pack;
  972. int err;
  973. int i;
  974. err = atk_ec_present(data);
  975. if (err < 0)
  976. return err;
  977. if (err) {
  978. err = atk_ec_enabled(data);
  979. if (err < 0)
  980. return err;
  981. /* If the EC was disabled we will disable it again on unload */
  982. data->disable_ec = err;
  983. err = atk_ec_ctl(data, 1);
  984. if (err) {
  985. data->disable_ec = false;
  986. return err;
  987. }
  988. }
  989. dev_dbg(dev, "Enumerating hwmon sensors\n");
  990. pack = atk_ggrp(data, ATK_MUX_HWMON);
  991. if (IS_ERR(pack))
  992. return PTR_ERR(pack);
  993. for (i = 0; i < pack->package.count; i++) {
  994. union acpi_object *obj = &pack->package.elements[i];
  995. atk_add_sensor(data, obj);
  996. }
  997. err = data->voltage_count + data->temperature_count + data->fan_count;
  998. ACPI_FREE(pack);
  999. return err;
  1000. }
  1001. static int atk_create_files(struct atk_data *data)
  1002. {
  1003. struct atk_sensor_data *s;
  1004. int err;
  1005. list_for_each_entry(s, &data->sensor_list, list) {
  1006. err = device_create_file(data->hwmon_dev, &s->input_attr);
  1007. if (err)
  1008. return err;
  1009. err = device_create_file(data->hwmon_dev, &s->label_attr);
  1010. if (err)
  1011. return err;
  1012. err = device_create_file(data->hwmon_dev, &s->limit1_attr);
  1013. if (err)
  1014. return err;
  1015. err = device_create_file(data->hwmon_dev, &s->limit2_attr);
  1016. if (err)
  1017. return err;
  1018. }
  1019. err = device_create_file(data->hwmon_dev, &atk_name_attr);
  1020. return err;
  1021. }
  1022. static void atk_remove_files(struct atk_data *data)
  1023. {
  1024. struct atk_sensor_data *s;
  1025. list_for_each_entry(s, &data->sensor_list, list) {
  1026. device_remove_file(data->hwmon_dev, &s->input_attr);
  1027. device_remove_file(data->hwmon_dev, &s->label_attr);
  1028. device_remove_file(data->hwmon_dev, &s->limit1_attr);
  1029. device_remove_file(data->hwmon_dev, &s->limit2_attr);
  1030. }
  1031. device_remove_file(data->hwmon_dev, &atk_name_attr);
  1032. }
  1033. static void atk_free_sensors(struct atk_data *data)
  1034. {
  1035. struct list_head *head = &data->sensor_list;
  1036. struct atk_sensor_data *s, *tmp;
  1037. list_for_each_entry_safe(s, tmp, head, list) {
  1038. kfree(s->acpi_name);
  1039. kfree(s);
  1040. }
  1041. }
  1042. static int atk_register_hwmon(struct atk_data *data)
  1043. {
  1044. struct device *dev = &data->acpi_dev->dev;
  1045. int err;
  1046. dev_dbg(dev, "registering hwmon device\n");
  1047. data->hwmon_dev = hwmon_device_register(dev);
  1048. if (IS_ERR(data->hwmon_dev))
  1049. return PTR_ERR(data->hwmon_dev);
  1050. dev_dbg(dev, "populating sysfs directory\n");
  1051. err = atk_create_files(data);
  1052. if (err)
  1053. goto remove;
  1054. return 0;
  1055. remove:
  1056. /* Cleanup the registered files */
  1057. atk_remove_files(data);
  1058. hwmon_device_unregister(data->hwmon_dev);
  1059. return err;
  1060. }
  1061. static int atk_probe_if(struct atk_data *data)
  1062. {
  1063. struct device *dev = &data->acpi_dev->dev;
  1064. acpi_handle ret;
  1065. acpi_status status;
  1066. int err = 0;
  1067. /* RTMP: read temperature */
  1068. status = acpi_get_handle(data->atk_handle, METHOD_OLD_READ_TMP, &ret);
  1069. if (ACPI_SUCCESS(status))
  1070. data->rtmp_handle = ret;
  1071. else
  1072. dev_dbg(dev, "method " METHOD_OLD_READ_TMP " not found: %s\n",
  1073. acpi_format_exception(status));
  1074. /* RVLT: read voltage */
  1075. status = acpi_get_handle(data->atk_handle, METHOD_OLD_READ_VLT, &ret);
  1076. if (ACPI_SUCCESS(status))
  1077. data->rvlt_handle = ret;
  1078. else
  1079. dev_dbg(dev, "method " METHOD_OLD_READ_VLT " not found: %s\n",
  1080. acpi_format_exception(status));
  1081. /* RFAN: read fan status */
  1082. status = acpi_get_handle(data->atk_handle, METHOD_OLD_READ_FAN, &ret);
  1083. if (ACPI_SUCCESS(status))
  1084. data->rfan_handle = ret;
  1085. else
  1086. dev_dbg(dev, "method " METHOD_OLD_READ_FAN " not found: %s\n",
  1087. acpi_format_exception(status));
  1088. /* Enumeration */
  1089. status = acpi_get_handle(data->atk_handle, METHOD_ENUMERATE, &ret);
  1090. if (ACPI_SUCCESS(status))
  1091. data->enumerate_handle = ret;
  1092. else
  1093. dev_dbg(dev, "method " METHOD_ENUMERATE " not found: %s\n",
  1094. acpi_format_exception(status));
  1095. /* De-multiplexer (read) */
  1096. status = acpi_get_handle(data->atk_handle, METHOD_READ, &ret);
  1097. if (ACPI_SUCCESS(status))
  1098. data->read_handle = ret;
  1099. else
  1100. dev_dbg(dev, "method " METHOD_READ " not found: %s\n",
  1101. acpi_format_exception(status));
  1102. /* De-multiplexer (write) */
  1103. status = acpi_get_handle(data->atk_handle, METHOD_WRITE, &ret);
  1104. if (ACPI_SUCCESS(status))
  1105. data->write_handle = ret;
  1106. else
  1107. dev_dbg(dev, "method " METHOD_WRITE " not found: %s\n",
  1108. acpi_format_exception(status));
  1109. /*
  1110. * Check for hwmon methods: first check "old" style methods; note that
  1111. * both may be present: in this case we stick to the old interface;
  1112. * analysis of multiple DSDTs indicates that when both interfaces
  1113. * are present the new one (GGRP/GITM) is not functional.
  1114. */
  1115. if (new_if)
  1116. dev_info(dev, "Overriding interface detection\n");
  1117. if (data->rtmp_handle &&
  1118. data->rvlt_handle && data->rfan_handle && !new_if)
  1119. data->old_interface = true;
  1120. else if (data->enumerate_handle && data->read_handle &&
  1121. data->write_handle)
  1122. data->old_interface = false;
  1123. else
  1124. err = -ENODEV;
  1125. return err;
  1126. }
  1127. static int atk_add(struct acpi_device *device)
  1128. {
  1129. acpi_status ret;
  1130. int err;
  1131. struct acpi_buffer buf;
  1132. union acpi_object *obj;
  1133. struct atk_data *data;
  1134. dev_dbg(&device->dev, "adding...\n");
  1135. data = kzalloc(sizeof(*data), GFP_KERNEL);
  1136. if (!data)
  1137. return -ENOMEM;
  1138. data->acpi_dev = device;
  1139. data->atk_handle = device->handle;
  1140. INIT_LIST_HEAD(&data->sensor_list);
  1141. data->disable_ec = false;
  1142. buf.length = ACPI_ALLOCATE_BUFFER;
  1143. ret = acpi_evaluate_object_typed(data->atk_handle, BOARD_ID, NULL,
  1144. &buf, ACPI_TYPE_PACKAGE);
  1145. if (ret != AE_OK) {
  1146. dev_dbg(&device->dev, "atk: method MBIF not found\n");
  1147. } else {
  1148. obj = buf.pointer;
  1149. if (obj->package.count >= 2) {
  1150. union acpi_object *id = &obj->package.elements[1];
  1151. if (id->type == ACPI_TYPE_STRING)
  1152. dev_dbg(&device->dev, "board ID = %s\n",
  1153. id->string.pointer);
  1154. }
  1155. ACPI_FREE(buf.pointer);
  1156. }
  1157. err = atk_probe_if(data);
  1158. if (err) {
  1159. dev_err(&device->dev, "No usable hwmon interface detected\n");
  1160. goto out;
  1161. }
  1162. if (data->old_interface) {
  1163. dev_dbg(&device->dev, "Using old hwmon interface\n");
  1164. err = atk_enumerate_old_hwmon(data);
  1165. } else {
  1166. dev_dbg(&device->dev, "Using new hwmon interface\n");
  1167. err = atk_enumerate_new_hwmon(data);
  1168. }
  1169. if (err < 0)
  1170. goto out;
  1171. if (err == 0) {
  1172. dev_info(&device->dev,
  1173. "No usable sensor detected, bailing out\n");
  1174. err = -ENODEV;
  1175. goto out;
  1176. }
  1177. err = atk_register_hwmon(data);
  1178. if (err)
  1179. goto cleanup;
  1180. atk_debugfs_init(data);
  1181. device->driver_data = data;
  1182. return 0;
  1183. cleanup:
  1184. atk_free_sensors(data);
  1185. out:
  1186. if (data->disable_ec)
  1187. atk_ec_ctl(data, 0);
  1188. kfree(data);
  1189. return err;
  1190. }
  1191. static int atk_remove(struct acpi_device *device, int type)
  1192. {
  1193. struct atk_data *data = device->driver_data;
  1194. dev_dbg(&device->dev, "removing...\n");
  1195. device->driver_data = NULL;
  1196. atk_debugfs_cleanup(data);
  1197. atk_remove_files(data);
  1198. atk_free_sensors(data);
  1199. hwmon_device_unregister(data->hwmon_dev);
  1200. if (data->disable_ec) {
  1201. if (atk_ec_ctl(data, 0))
  1202. dev_err(&device->dev, "Failed to disable EC\n");
  1203. }
  1204. kfree(data);
  1205. return 0;
  1206. }
  1207. static int __init atk0110_init(void)
  1208. {
  1209. int ret;
  1210. /* Make sure it's safe to access the device through ACPI */
  1211. if (!acpi_resources_are_enforced()) {
  1212. pr_err("Resources not safely usable due to acpi_enforce_resources kernel parameter\n");
  1213. return -EBUSY;
  1214. }
  1215. if (dmi_check_system(atk_force_new_if))
  1216. new_if = true;
  1217. ret = acpi_bus_register_driver(&atk_driver);
  1218. if (ret)
  1219. pr_info("acpi_bus_register_driver failed: %d\n", ret);
  1220. return ret;
  1221. }
  1222. static void __exit atk0110_exit(void)
  1223. {
  1224. acpi_bus_unregister_driver(&atk_driver);
  1225. }
  1226. module_init(atk0110_init);
  1227. module_exit(atk0110_exit);
  1228. MODULE_LICENSE("GPL");