asus_atk0110.c 33 KB

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