asus_atk0110.c 33 KB

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