asus_atk0110.c 33 KB

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