rsparser.c 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168
  1. /*
  2. * pnpacpi -- PnP ACPI driver
  3. *
  4. * Copyright (c) 2004 Matthieu Castet <castet.matthieu@free.fr>
  5. * Copyright (c) 2004 Li Shaohua <shaohua.li@intel.com>
  6. * Copyright (C) 2008 Hewlett-Packard Development Company, L.P.
  7. * Bjorn Helgaas <bjorn.helgaas@hp.com>
  8. *
  9. * This program is free software; you can redistribute it and/or modify it
  10. * under the terms of the GNU General Public License as published by the
  11. * Free Software Foundation; either version 2, or (at your option) any
  12. * later version.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  22. */
  23. #include <linux/kernel.h>
  24. #include <linux/acpi.h>
  25. #include <linux/pci.h>
  26. #include <linux/pnp.h>
  27. #include "../base.h"
  28. #include "pnpacpi.h"
  29. #ifdef CONFIG_IA64
  30. #define valid_IRQ(i) (1)
  31. #else
  32. #define valid_IRQ(i) (((i) != 0) && ((i) != 2))
  33. #endif
  34. /*
  35. * Allocated Resources
  36. */
  37. static int irq_flags(int triggering, int polarity, int shareable)
  38. {
  39. int flags;
  40. if (triggering == ACPI_LEVEL_SENSITIVE) {
  41. if (polarity == ACPI_ACTIVE_LOW)
  42. flags = IORESOURCE_IRQ_LOWLEVEL;
  43. else
  44. flags = IORESOURCE_IRQ_HIGHLEVEL;
  45. } else {
  46. if (polarity == ACPI_ACTIVE_LOW)
  47. flags = IORESOURCE_IRQ_LOWEDGE;
  48. else
  49. flags = IORESOURCE_IRQ_HIGHEDGE;
  50. }
  51. if (shareable == ACPI_SHARED)
  52. flags |= IORESOURCE_IRQ_SHAREABLE;
  53. return flags;
  54. }
  55. static void decode_irq_flags(struct pnp_dev *dev, int flags, int *triggering,
  56. int *polarity, int *shareable)
  57. {
  58. switch (flags & (IORESOURCE_IRQ_LOWLEVEL | IORESOURCE_IRQ_HIGHLEVEL |
  59. IORESOURCE_IRQ_LOWEDGE | IORESOURCE_IRQ_HIGHEDGE)) {
  60. case IORESOURCE_IRQ_LOWLEVEL:
  61. *triggering = ACPI_LEVEL_SENSITIVE;
  62. *polarity = ACPI_ACTIVE_LOW;
  63. break;
  64. case IORESOURCE_IRQ_HIGHLEVEL:
  65. *triggering = ACPI_LEVEL_SENSITIVE;
  66. *polarity = ACPI_ACTIVE_HIGH;
  67. break;
  68. case IORESOURCE_IRQ_LOWEDGE:
  69. *triggering = ACPI_EDGE_SENSITIVE;
  70. *polarity = ACPI_ACTIVE_LOW;
  71. break;
  72. case IORESOURCE_IRQ_HIGHEDGE:
  73. *triggering = ACPI_EDGE_SENSITIVE;
  74. *polarity = ACPI_ACTIVE_HIGH;
  75. break;
  76. default:
  77. dev_err(&dev->dev, "can't encode invalid IRQ mode %#x\n",
  78. flags);
  79. *triggering = ACPI_EDGE_SENSITIVE;
  80. *polarity = ACPI_ACTIVE_HIGH;
  81. break;
  82. }
  83. if (flags & IORESOURCE_IRQ_SHAREABLE)
  84. *shareable = ACPI_SHARED;
  85. else
  86. *shareable = ACPI_EXCLUSIVE;
  87. }
  88. static void pnpacpi_parse_allocated_irqresource(struct pnp_dev *dev,
  89. u32 gsi, int triggering,
  90. int polarity, int shareable)
  91. {
  92. int irq, flags;
  93. int p, t;
  94. if (!valid_IRQ(gsi)) {
  95. pnp_add_irq_resource(dev, gsi, IORESOURCE_DISABLED);
  96. return;
  97. }
  98. /*
  99. * in IO-APIC mode, use overrided attribute. Two reasons:
  100. * 1. BIOS bug in DSDT
  101. * 2. BIOS uses IO-APIC mode Interrupt Source Override
  102. */
  103. if (!acpi_get_override_irq(gsi, &t, &p)) {
  104. t = t ? ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE;
  105. p = p ? ACPI_ACTIVE_LOW : ACPI_ACTIVE_HIGH;
  106. if (triggering != t || polarity != p) {
  107. dev_warn(&dev->dev, "IRQ %d override to %s, %s\n",
  108. gsi, t ? "edge":"level", p ? "low":"high");
  109. triggering = t;
  110. polarity = p;
  111. }
  112. }
  113. flags = irq_flags(triggering, polarity, shareable);
  114. irq = acpi_register_gsi(&dev->dev, gsi, triggering, polarity);
  115. if (irq >= 0)
  116. pcibios_penalize_isa_irq(irq, 1);
  117. else
  118. flags |= IORESOURCE_DISABLED;
  119. pnp_add_irq_resource(dev, irq, flags);
  120. }
  121. static int dma_flags(struct pnp_dev *dev, int type, int bus_master,
  122. int transfer)
  123. {
  124. int flags = 0;
  125. if (bus_master)
  126. flags |= IORESOURCE_DMA_MASTER;
  127. switch (type) {
  128. case ACPI_COMPATIBILITY:
  129. flags |= IORESOURCE_DMA_COMPATIBLE;
  130. break;
  131. case ACPI_TYPE_A:
  132. flags |= IORESOURCE_DMA_TYPEA;
  133. break;
  134. case ACPI_TYPE_B:
  135. flags |= IORESOURCE_DMA_TYPEB;
  136. break;
  137. case ACPI_TYPE_F:
  138. flags |= IORESOURCE_DMA_TYPEF;
  139. break;
  140. default:
  141. /* Set a default value ? */
  142. flags |= IORESOURCE_DMA_COMPATIBLE;
  143. dev_err(&dev->dev, "invalid DMA type %d\n", type);
  144. }
  145. switch (transfer) {
  146. case ACPI_TRANSFER_8:
  147. flags |= IORESOURCE_DMA_8BIT;
  148. break;
  149. case ACPI_TRANSFER_8_16:
  150. flags |= IORESOURCE_DMA_8AND16BIT;
  151. break;
  152. case ACPI_TRANSFER_16:
  153. flags |= IORESOURCE_DMA_16BIT;
  154. break;
  155. default:
  156. /* Set a default value ? */
  157. flags |= IORESOURCE_DMA_8AND16BIT;
  158. dev_err(&dev->dev, "invalid DMA transfer type %d\n", transfer);
  159. }
  160. return flags;
  161. }
  162. static void pnpacpi_parse_allocated_ioresource(struct pnp_dev *dev, u64 start,
  163. u64 len, int io_decode)
  164. {
  165. int flags = 0;
  166. u64 end = start + len - 1;
  167. if (io_decode == ACPI_DECODE_16)
  168. flags |= IORESOURCE_IO_16BIT_ADDR;
  169. if (len == 0 || end >= 0x10003)
  170. flags |= IORESOURCE_DISABLED;
  171. pnp_add_io_resource(dev, start, end, flags);
  172. }
  173. /*
  174. * Device CSRs that do not appear in PCI config space should be described
  175. * via ACPI. This would normally be done with Address Space Descriptors
  176. * marked as "consumer-only," but old versions of Windows and Linux ignore
  177. * the producer/consumer flag, so HP invented a vendor-defined resource to
  178. * describe the location and size of CSR space.
  179. */
  180. static struct acpi_vendor_uuid hp_ccsr_uuid = {
  181. .subtype = 2,
  182. .data = { 0xf9, 0xad, 0xe9, 0x69, 0x4f, 0x92, 0x5f, 0xab, 0xf6, 0x4a,
  183. 0x24, 0xd2, 0x01, 0x37, 0x0e, 0xad },
  184. };
  185. static int vendor_resource_matches(struct pnp_dev *dev,
  186. struct acpi_resource_vendor_typed *vendor,
  187. struct acpi_vendor_uuid *match,
  188. int expected_len)
  189. {
  190. int uuid_len = sizeof(vendor->uuid);
  191. u8 uuid_subtype = vendor->uuid_subtype;
  192. u8 *uuid = vendor->uuid;
  193. int actual_len;
  194. /* byte_length includes uuid_subtype and uuid */
  195. actual_len = vendor->byte_length - uuid_len - 1;
  196. if (uuid_subtype == match->subtype &&
  197. uuid_len == sizeof(match->data) &&
  198. memcmp(uuid, match->data, uuid_len) == 0) {
  199. if (expected_len && expected_len != actual_len) {
  200. dev_err(&dev->dev, "wrong vendor descriptor size; "
  201. "expected %d, found %d bytes\n",
  202. expected_len, actual_len);
  203. return 0;
  204. }
  205. return 1;
  206. }
  207. return 0;
  208. }
  209. static void pnpacpi_parse_allocated_vendor(struct pnp_dev *dev,
  210. struct acpi_resource_vendor_typed *vendor)
  211. {
  212. if (vendor_resource_matches(dev, vendor, &hp_ccsr_uuid, 16)) {
  213. u64 start, length;
  214. memcpy(&start, vendor->byte_data, sizeof(start));
  215. memcpy(&length, vendor->byte_data + 8, sizeof(length));
  216. pnp_add_mem_resource(dev, start, start + length - 1, 0);
  217. }
  218. }
  219. static void pnpacpi_parse_allocated_memresource(struct pnp_dev *dev,
  220. u64 start, u64 len,
  221. int write_protect)
  222. {
  223. int flags = 0;
  224. u64 end = start + len - 1;
  225. if (len == 0)
  226. flags |= IORESOURCE_DISABLED;
  227. if (write_protect == ACPI_READ_WRITE_MEMORY)
  228. flags |= IORESOURCE_MEM_WRITEABLE;
  229. pnp_add_mem_resource(dev, start, end, flags);
  230. }
  231. static void pnpacpi_parse_allocated_address_space(struct pnp_dev *dev,
  232. struct acpi_resource *res)
  233. {
  234. struct acpi_resource_address64 addr, *p = &addr;
  235. acpi_status status;
  236. status = acpi_resource_to_address64(res, p);
  237. if (!ACPI_SUCCESS(status)) {
  238. dev_warn(&dev->dev, "failed to convert resource type %d\n",
  239. res->type);
  240. return;
  241. }
  242. if (p->producer_consumer == ACPI_PRODUCER)
  243. return;
  244. if (p->resource_type == ACPI_MEMORY_RANGE)
  245. pnpacpi_parse_allocated_memresource(dev,
  246. p->minimum, p->address_length,
  247. p->info.mem.write_protect);
  248. else if (p->resource_type == ACPI_IO_RANGE)
  249. pnpacpi_parse_allocated_ioresource(dev,
  250. p->minimum, p->address_length,
  251. p->granularity == 0xfff ? ACPI_DECODE_10 :
  252. ACPI_DECODE_16);
  253. }
  254. static void pnpacpi_parse_allocated_ext_address_space(struct pnp_dev *dev,
  255. struct acpi_resource *res)
  256. {
  257. struct acpi_resource_extended_address64 *p = &res->data.ext_address64;
  258. if (p->producer_consumer == ACPI_PRODUCER)
  259. return;
  260. if (p->resource_type == ACPI_MEMORY_RANGE)
  261. pnpacpi_parse_allocated_memresource(dev,
  262. p->minimum, p->address_length,
  263. p->info.mem.write_protect);
  264. else if (p->resource_type == ACPI_IO_RANGE)
  265. pnpacpi_parse_allocated_ioresource(dev,
  266. p->minimum, p->address_length,
  267. p->granularity == 0xfff ? ACPI_DECODE_10 :
  268. ACPI_DECODE_16);
  269. }
  270. static acpi_status pnpacpi_allocated_resource(struct acpi_resource *res,
  271. void *data)
  272. {
  273. struct pnp_dev *dev = data;
  274. struct acpi_resource_irq *irq;
  275. struct acpi_resource_dma *dma;
  276. struct acpi_resource_io *io;
  277. struct acpi_resource_fixed_io *fixed_io;
  278. struct acpi_resource_vendor_typed *vendor_typed;
  279. struct acpi_resource_memory24 *memory24;
  280. struct acpi_resource_memory32 *memory32;
  281. struct acpi_resource_fixed_memory32 *fixed_memory32;
  282. struct acpi_resource_extended_irq *extended_irq;
  283. int i, flags;
  284. switch (res->type) {
  285. case ACPI_RESOURCE_TYPE_IRQ:
  286. /*
  287. * Per spec, only one interrupt per descriptor is allowed in
  288. * _CRS, but some firmware violates this, so parse them all.
  289. */
  290. irq = &res->data.irq;
  291. if (irq->interrupt_count == 0)
  292. pnp_add_irq_resource(dev, 0, IORESOURCE_DISABLED);
  293. else {
  294. for (i = 0; i < irq->interrupt_count; i++) {
  295. pnpacpi_parse_allocated_irqresource(dev,
  296. irq->interrupts[i],
  297. irq->triggering,
  298. irq->polarity,
  299. irq->sharable);
  300. }
  301. /*
  302. * The IRQ encoder puts a single interrupt in each
  303. * descriptor, so if a _CRS descriptor has more than
  304. * one interrupt, we won't be able to re-encode it.
  305. */
  306. if (pnp_can_write(dev) && irq->interrupt_count > 1) {
  307. dev_warn(&dev->dev, "multiple interrupts in "
  308. "_CRS descriptor; configuration can't "
  309. "be changed\n");
  310. dev->capabilities &= ~PNP_WRITE;
  311. }
  312. }
  313. break;
  314. case ACPI_RESOURCE_TYPE_DMA:
  315. dma = &res->data.dma;
  316. if (dma->channel_count > 0 && dma->channels[0] != (u8) -1)
  317. flags = dma_flags(dev, dma->type, dma->bus_master,
  318. dma->transfer);
  319. else
  320. flags = IORESOURCE_DISABLED;
  321. pnp_add_dma_resource(dev, dma->channels[0], flags);
  322. break;
  323. case ACPI_RESOURCE_TYPE_IO:
  324. io = &res->data.io;
  325. pnpacpi_parse_allocated_ioresource(dev,
  326. io->minimum,
  327. io->address_length,
  328. io->io_decode);
  329. break;
  330. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  331. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  332. break;
  333. case ACPI_RESOURCE_TYPE_FIXED_IO:
  334. fixed_io = &res->data.fixed_io;
  335. pnpacpi_parse_allocated_ioresource(dev,
  336. fixed_io->address,
  337. fixed_io->address_length,
  338. ACPI_DECODE_10);
  339. break;
  340. case ACPI_RESOURCE_TYPE_VENDOR:
  341. vendor_typed = &res->data.vendor_typed;
  342. pnpacpi_parse_allocated_vendor(dev, vendor_typed);
  343. break;
  344. case ACPI_RESOURCE_TYPE_END_TAG:
  345. break;
  346. case ACPI_RESOURCE_TYPE_MEMORY24:
  347. memory24 = &res->data.memory24;
  348. pnpacpi_parse_allocated_memresource(dev,
  349. memory24->minimum,
  350. memory24->address_length,
  351. memory24->write_protect);
  352. break;
  353. case ACPI_RESOURCE_TYPE_MEMORY32:
  354. memory32 = &res->data.memory32;
  355. pnpacpi_parse_allocated_memresource(dev,
  356. memory32->minimum,
  357. memory32->address_length,
  358. memory32->write_protect);
  359. break;
  360. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  361. fixed_memory32 = &res->data.fixed_memory32;
  362. pnpacpi_parse_allocated_memresource(dev,
  363. fixed_memory32->address,
  364. fixed_memory32->address_length,
  365. fixed_memory32->write_protect);
  366. break;
  367. case ACPI_RESOURCE_TYPE_ADDRESS16:
  368. case ACPI_RESOURCE_TYPE_ADDRESS32:
  369. case ACPI_RESOURCE_TYPE_ADDRESS64:
  370. pnpacpi_parse_allocated_address_space(dev, res);
  371. break;
  372. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  373. pnpacpi_parse_allocated_ext_address_space(dev, res);
  374. break;
  375. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  376. extended_irq = &res->data.extended_irq;
  377. if (extended_irq->interrupt_count == 0)
  378. pnp_add_irq_resource(dev, 0, IORESOURCE_DISABLED);
  379. else {
  380. for (i = 0; i < extended_irq->interrupt_count; i++) {
  381. pnpacpi_parse_allocated_irqresource(dev,
  382. extended_irq->interrupts[i],
  383. extended_irq->triggering,
  384. extended_irq->polarity,
  385. extended_irq->sharable);
  386. }
  387. /*
  388. * The IRQ encoder puts a single interrupt in each
  389. * descriptor, so if a _CRS descriptor has more than
  390. * one interrupt, we won't be able to re-encode it.
  391. */
  392. if (pnp_can_write(dev) &&
  393. extended_irq->interrupt_count > 1) {
  394. dev_warn(&dev->dev, "multiple interrupts in "
  395. "_CRS descriptor; configuration can't "
  396. "be changed\n");
  397. dev->capabilities &= ~PNP_WRITE;
  398. }
  399. }
  400. break;
  401. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  402. break;
  403. default:
  404. dev_warn(&dev->dev, "unknown resource type %d in _CRS\n",
  405. res->type);
  406. return AE_ERROR;
  407. }
  408. return AE_OK;
  409. }
  410. int pnpacpi_parse_allocated_resource(struct pnp_dev *dev)
  411. {
  412. acpi_handle handle = dev->data;
  413. acpi_status status;
  414. pnp_dbg(&dev->dev, "parse allocated resources\n");
  415. pnp_init_resources(dev);
  416. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  417. pnpacpi_allocated_resource, dev);
  418. if (ACPI_FAILURE(status)) {
  419. if (status != AE_NOT_FOUND)
  420. dev_err(&dev->dev, "can't evaluate _CRS: %d", status);
  421. return -EPERM;
  422. }
  423. return 0;
  424. }
  425. static __init void pnpacpi_parse_dma_option(struct pnp_dev *dev,
  426. unsigned int option_flags,
  427. struct acpi_resource_dma *p)
  428. {
  429. int i;
  430. unsigned char map = 0, flags;
  431. if (p->channel_count == 0)
  432. return;
  433. for (i = 0; i < p->channel_count; i++)
  434. map |= 1 << p->channels[i];
  435. flags = dma_flags(dev, p->type, p->bus_master, p->transfer);
  436. pnp_register_dma_resource(dev, option_flags, map, flags);
  437. }
  438. static __init void pnpacpi_parse_irq_option(struct pnp_dev *dev,
  439. unsigned int option_flags,
  440. struct acpi_resource_irq *p)
  441. {
  442. int i;
  443. pnp_irq_mask_t map;
  444. unsigned char flags;
  445. if (p->interrupt_count == 0)
  446. return;
  447. bitmap_zero(map.bits, PNP_IRQ_NR);
  448. for (i = 0; i < p->interrupt_count; i++)
  449. if (p->interrupts[i])
  450. __set_bit(p->interrupts[i], map.bits);
  451. flags = irq_flags(p->triggering, p->polarity, p->sharable);
  452. pnp_register_irq_resource(dev, option_flags, &map, flags);
  453. }
  454. static __init void pnpacpi_parse_ext_irq_option(struct pnp_dev *dev,
  455. unsigned int option_flags,
  456. struct acpi_resource_extended_irq *p)
  457. {
  458. int i;
  459. pnp_irq_mask_t map;
  460. unsigned char flags;
  461. if (p->interrupt_count == 0)
  462. return;
  463. bitmap_zero(map.bits, PNP_IRQ_NR);
  464. for (i = 0; i < p->interrupt_count; i++) {
  465. if (p->interrupts[i]) {
  466. if (p->interrupts[i] < PNP_IRQ_NR)
  467. __set_bit(p->interrupts[i], map.bits);
  468. else
  469. dev_err(&dev->dev, "ignoring IRQ %d option "
  470. "(too large for %d entry bitmap)\n",
  471. p->interrupts[i], PNP_IRQ_NR);
  472. }
  473. }
  474. flags = irq_flags(p->triggering, p->polarity, p->sharable);
  475. pnp_register_irq_resource(dev, option_flags, &map, flags);
  476. }
  477. static __init void pnpacpi_parse_port_option(struct pnp_dev *dev,
  478. unsigned int option_flags,
  479. struct acpi_resource_io *io)
  480. {
  481. unsigned char flags = 0;
  482. if (io->address_length == 0)
  483. return;
  484. if (io->io_decode == ACPI_DECODE_16)
  485. flags = IORESOURCE_IO_16BIT_ADDR;
  486. pnp_register_port_resource(dev, option_flags, io->minimum, io->maximum,
  487. io->alignment, io->address_length, flags);
  488. }
  489. static __init void pnpacpi_parse_fixed_port_option(struct pnp_dev *dev,
  490. unsigned int option_flags,
  491. struct acpi_resource_fixed_io *io)
  492. {
  493. if (io->address_length == 0)
  494. return;
  495. pnp_register_port_resource(dev, option_flags, io->address, io->address,
  496. 0, io->address_length, IORESOURCE_IO_FIXED);
  497. }
  498. static __init void pnpacpi_parse_mem24_option(struct pnp_dev *dev,
  499. unsigned int option_flags,
  500. struct acpi_resource_memory24 *p)
  501. {
  502. unsigned char flags = 0;
  503. if (p->address_length == 0)
  504. return;
  505. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  506. flags = IORESOURCE_MEM_WRITEABLE;
  507. pnp_register_mem_resource(dev, option_flags, p->minimum, p->maximum,
  508. p->alignment, p->address_length, flags);
  509. }
  510. static __init void pnpacpi_parse_mem32_option(struct pnp_dev *dev,
  511. unsigned int option_flags,
  512. struct acpi_resource_memory32 *p)
  513. {
  514. unsigned char flags = 0;
  515. if (p->address_length == 0)
  516. return;
  517. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  518. flags = IORESOURCE_MEM_WRITEABLE;
  519. pnp_register_mem_resource(dev, option_flags, p->minimum, p->maximum,
  520. p->alignment, p->address_length, flags);
  521. }
  522. static __init void pnpacpi_parse_fixed_mem32_option(struct pnp_dev *dev,
  523. unsigned int option_flags,
  524. struct acpi_resource_fixed_memory32 *p)
  525. {
  526. unsigned char flags = 0;
  527. if (p->address_length == 0)
  528. return;
  529. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  530. flags = IORESOURCE_MEM_WRITEABLE;
  531. pnp_register_mem_resource(dev, option_flags, p->address, p->address,
  532. 0, p->address_length, flags);
  533. }
  534. static __init void pnpacpi_parse_address_option(struct pnp_dev *dev,
  535. unsigned int option_flags,
  536. struct acpi_resource *r)
  537. {
  538. struct acpi_resource_address64 addr, *p = &addr;
  539. acpi_status status;
  540. unsigned char flags = 0;
  541. status = acpi_resource_to_address64(r, p);
  542. if (ACPI_FAILURE(status)) {
  543. dev_warn(&dev->dev, "can't convert resource type %d\n",
  544. r->type);
  545. return;
  546. }
  547. if (p->address_length == 0)
  548. return;
  549. if (p->resource_type == ACPI_MEMORY_RANGE) {
  550. if (p->info.mem.write_protect == ACPI_READ_WRITE_MEMORY)
  551. flags = IORESOURCE_MEM_WRITEABLE;
  552. pnp_register_mem_resource(dev, option_flags, p->minimum,
  553. p->minimum, 0, p->address_length,
  554. flags);
  555. } else if (p->resource_type == ACPI_IO_RANGE)
  556. pnp_register_port_resource(dev, option_flags, p->minimum,
  557. p->minimum, 0, p->address_length,
  558. IORESOURCE_IO_FIXED);
  559. }
  560. static __init void pnpacpi_parse_ext_address_option(struct pnp_dev *dev,
  561. unsigned int option_flags,
  562. struct acpi_resource *r)
  563. {
  564. struct acpi_resource_extended_address64 *p = &r->data.ext_address64;
  565. unsigned char flags = 0;
  566. if (p->address_length == 0)
  567. return;
  568. if (p->resource_type == ACPI_MEMORY_RANGE) {
  569. if (p->info.mem.write_protect == ACPI_READ_WRITE_MEMORY)
  570. flags = IORESOURCE_MEM_WRITEABLE;
  571. pnp_register_mem_resource(dev, option_flags, p->minimum,
  572. p->minimum, 0, p->address_length,
  573. flags);
  574. } else if (p->resource_type == ACPI_IO_RANGE)
  575. pnp_register_port_resource(dev, option_flags, p->minimum,
  576. p->minimum, 0, p->address_length,
  577. IORESOURCE_IO_FIXED);
  578. }
  579. struct acpipnp_parse_option_s {
  580. struct pnp_dev *dev;
  581. unsigned int option_flags;
  582. };
  583. static __init acpi_status pnpacpi_option_resource(struct acpi_resource *res,
  584. void *data)
  585. {
  586. int priority;
  587. struct acpipnp_parse_option_s *parse_data = data;
  588. struct pnp_dev *dev = parse_data->dev;
  589. unsigned int option_flags = parse_data->option_flags;
  590. switch (res->type) {
  591. case ACPI_RESOURCE_TYPE_IRQ:
  592. pnpacpi_parse_irq_option(dev, option_flags, &res->data.irq);
  593. break;
  594. case ACPI_RESOURCE_TYPE_DMA:
  595. pnpacpi_parse_dma_option(dev, option_flags, &res->data.dma);
  596. break;
  597. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  598. switch (res->data.start_dpf.compatibility_priority) {
  599. case ACPI_GOOD_CONFIGURATION:
  600. priority = PNP_RES_PRIORITY_PREFERRED;
  601. break;
  602. case ACPI_ACCEPTABLE_CONFIGURATION:
  603. priority = PNP_RES_PRIORITY_ACCEPTABLE;
  604. break;
  605. case ACPI_SUB_OPTIMAL_CONFIGURATION:
  606. priority = PNP_RES_PRIORITY_FUNCTIONAL;
  607. break;
  608. default:
  609. priority = PNP_RES_PRIORITY_INVALID;
  610. break;
  611. }
  612. parse_data->option_flags = pnp_new_dependent_set(dev, priority);
  613. break;
  614. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  615. parse_data->option_flags = 0;
  616. break;
  617. case ACPI_RESOURCE_TYPE_IO:
  618. pnpacpi_parse_port_option(dev, option_flags, &res->data.io);
  619. break;
  620. case ACPI_RESOURCE_TYPE_FIXED_IO:
  621. pnpacpi_parse_fixed_port_option(dev, option_flags,
  622. &res->data.fixed_io);
  623. break;
  624. case ACPI_RESOURCE_TYPE_VENDOR:
  625. case ACPI_RESOURCE_TYPE_END_TAG:
  626. break;
  627. case ACPI_RESOURCE_TYPE_MEMORY24:
  628. pnpacpi_parse_mem24_option(dev, option_flags,
  629. &res->data.memory24);
  630. break;
  631. case ACPI_RESOURCE_TYPE_MEMORY32:
  632. pnpacpi_parse_mem32_option(dev, option_flags,
  633. &res->data.memory32);
  634. break;
  635. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  636. pnpacpi_parse_fixed_mem32_option(dev, option_flags,
  637. &res->data.fixed_memory32);
  638. break;
  639. case ACPI_RESOURCE_TYPE_ADDRESS16:
  640. case ACPI_RESOURCE_TYPE_ADDRESS32:
  641. case ACPI_RESOURCE_TYPE_ADDRESS64:
  642. pnpacpi_parse_address_option(dev, option_flags, res);
  643. break;
  644. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  645. pnpacpi_parse_ext_address_option(dev, option_flags, res);
  646. break;
  647. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  648. pnpacpi_parse_ext_irq_option(dev, option_flags,
  649. &res->data.extended_irq);
  650. break;
  651. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  652. break;
  653. default:
  654. dev_warn(&dev->dev, "unknown resource type %d in _PRS\n",
  655. res->type);
  656. return AE_ERROR;
  657. }
  658. return AE_OK;
  659. }
  660. int __init pnpacpi_parse_resource_option_data(struct pnp_dev *dev)
  661. {
  662. acpi_handle handle = dev->data;
  663. acpi_status status;
  664. struct acpipnp_parse_option_s parse_data;
  665. pnp_dbg(&dev->dev, "parse resource options\n");
  666. parse_data.dev = dev;
  667. parse_data.option_flags = 0;
  668. status = acpi_walk_resources(handle, METHOD_NAME__PRS,
  669. pnpacpi_option_resource, &parse_data);
  670. if (ACPI_FAILURE(status)) {
  671. if (status != AE_NOT_FOUND)
  672. dev_err(&dev->dev, "can't evaluate _PRS: %d", status);
  673. return -EPERM;
  674. }
  675. return 0;
  676. }
  677. static int pnpacpi_supported_resource(struct acpi_resource *res)
  678. {
  679. switch (res->type) {
  680. case ACPI_RESOURCE_TYPE_IRQ:
  681. case ACPI_RESOURCE_TYPE_DMA:
  682. case ACPI_RESOURCE_TYPE_IO:
  683. case ACPI_RESOURCE_TYPE_FIXED_IO:
  684. case ACPI_RESOURCE_TYPE_MEMORY24:
  685. case ACPI_RESOURCE_TYPE_MEMORY32:
  686. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  687. case ACPI_RESOURCE_TYPE_ADDRESS16:
  688. case ACPI_RESOURCE_TYPE_ADDRESS32:
  689. case ACPI_RESOURCE_TYPE_ADDRESS64:
  690. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  691. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  692. return 1;
  693. }
  694. return 0;
  695. }
  696. /*
  697. * Set resource
  698. */
  699. static acpi_status pnpacpi_count_resources(struct acpi_resource *res,
  700. void *data)
  701. {
  702. int *res_cnt = data;
  703. if (pnpacpi_supported_resource(res))
  704. (*res_cnt)++;
  705. return AE_OK;
  706. }
  707. static acpi_status pnpacpi_type_resources(struct acpi_resource *res, void *data)
  708. {
  709. struct acpi_resource **resource = data;
  710. if (pnpacpi_supported_resource(res)) {
  711. (*resource)->type = res->type;
  712. (*resource)->length = sizeof(struct acpi_resource);
  713. if (res->type == ACPI_RESOURCE_TYPE_IRQ)
  714. (*resource)->data.irq.descriptor_length =
  715. res->data.irq.descriptor_length;
  716. (*resource)++;
  717. }
  718. return AE_OK;
  719. }
  720. int pnpacpi_build_resource_template(struct pnp_dev *dev,
  721. struct acpi_buffer *buffer)
  722. {
  723. acpi_handle handle = dev->data;
  724. struct acpi_resource *resource;
  725. int res_cnt = 0;
  726. acpi_status status;
  727. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  728. pnpacpi_count_resources, &res_cnt);
  729. if (ACPI_FAILURE(status)) {
  730. dev_err(&dev->dev, "can't evaluate _CRS: %d\n", status);
  731. return -EINVAL;
  732. }
  733. if (!res_cnt)
  734. return -EINVAL;
  735. buffer->length = sizeof(struct acpi_resource) * (res_cnt + 1) + 1;
  736. buffer->pointer = kzalloc(buffer->length - 1, GFP_KERNEL);
  737. if (!buffer->pointer)
  738. return -ENOMEM;
  739. resource = (struct acpi_resource *)buffer->pointer;
  740. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  741. pnpacpi_type_resources, &resource);
  742. if (ACPI_FAILURE(status)) {
  743. kfree(buffer->pointer);
  744. dev_err(&dev->dev, "can't evaluate _CRS: %d\n", status);
  745. return -EINVAL;
  746. }
  747. /* resource will pointer the end resource now */
  748. resource->type = ACPI_RESOURCE_TYPE_END_TAG;
  749. return 0;
  750. }
  751. static void pnpacpi_encode_irq(struct pnp_dev *dev,
  752. struct acpi_resource *resource,
  753. struct resource *p)
  754. {
  755. struct acpi_resource_irq *irq = &resource->data.irq;
  756. int triggering, polarity, shareable;
  757. if (!pnp_resource_enabled(p)) {
  758. irq->interrupt_count = 0;
  759. pnp_dbg(&dev->dev, " encode irq (%s)\n",
  760. p ? "disabled" : "missing");
  761. return;
  762. }
  763. decode_irq_flags(dev, p->flags, &triggering, &polarity, &shareable);
  764. irq->triggering = triggering;
  765. irq->polarity = polarity;
  766. irq->sharable = shareable;
  767. irq->interrupt_count = 1;
  768. irq->interrupts[0] = p->start;
  769. pnp_dbg(&dev->dev, " encode irq %d %s %s %s (%d-byte descriptor)\n",
  770. (int) p->start,
  771. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  772. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  773. irq->sharable == ACPI_SHARED ? "shared" : "exclusive",
  774. irq->descriptor_length);
  775. }
  776. static void pnpacpi_encode_ext_irq(struct pnp_dev *dev,
  777. struct acpi_resource *resource,
  778. struct resource *p)
  779. {
  780. struct acpi_resource_extended_irq *extended_irq = &resource->data.extended_irq;
  781. int triggering, polarity, shareable;
  782. if (!pnp_resource_enabled(p)) {
  783. extended_irq->interrupt_count = 0;
  784. pnp_dbg(&dev->dev, " encode extended irq (%s)\n",
  785. p ? "disabled" : "missing");
  786. return;
  787. }
  788. decode_irq_flags(dev, p->flags, &triggering, &polarity, &shareable);
  789. extended_irq->producer_consumer = ACPI_CONSUMER;
  790. extended_irq->triggering = triggering;
  791. extended_irq->polarity = polarity;
  792. extended_irq->sharable = shareable;
  793. extended_irq->interrupt_count = 1;
  794. extended_irq->interrupts[0] = p->start;
  795. pnp_dbg(&dev->dev, " encode irq %d %s %s %s\n", (int) p->start,
  796. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  797. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  798. extended_irq->sharable == ACPI_SHARED ? "shared" : "exclusive");
  799. }
  800. static void pnpacpi_encode_dma(struct pnp_dev *dev,
  801. struct acpi_resource *resource,
  802. struct resource *p)
  803. {
  804. struct acpi_resource_dma *dma = &resource->data.dma;
  805. if (!pnp_resource_enabled(p)) {
  806. dma->channel_count = 0;
  807. pnp_dbg(&dev->dev, " encode dma (%s)\n",
  808. p ? "disabled" : "missing");
  809. return;
  810. }
  811. /* Note: pnp_assign_dma will copy pnp_dma->flags into p->flags */
  812. switch (p->flags & IORESOURCE_DMA_SPEED_MASK) {
  813. case IORESOURCE_DMA_TYPEA:
  814. dma->type = ACPI_TYPE_A;
  815. break;
  816. case IORESOURCE_DMA_TYPEB:
  817. dma->type = ACPI_TYPE_B;
  818. break;
  819. case IORESOURCE_DMA_TYPEF:
  820. dma->type = ACPI_TYPE_F;
  821. break;
  822. default:
  823. dma->type = ACPI_COMPATIBILITY;
  824. }
  825. switch (p->flags & IORESOURCE_DMA_TYPE_MASK) {
  826. case IORESOURCE_DMA_8BIT:
  827. dma->transfer = ACPI_TRANSFER_8;
  828. break;
  829. case IORESOURCE_DMA_8AND16BIT:
  830. dma->transfer = ACPI_TRANSFER_8_16;
  831. break;
  832. default:
  833. dma->transfer = ACPI_TRANSFER_16;
  834. }
  835. dma->bus_master = !!(p->flags & IORESOURCE_DMA_MASTER);
  836. dma->channel_count = 1;
  837. dma->channels[0] = p->start;
  838. pnp_dbg(&dev->dev, " encode dma %d "
  839. "type %#x transfer %#x master %d\n",
  840. (int) p->start, dma->type, dma->transfer, dma->bus_master);
  841. }
  842. static void pnpacpi_encode_io(struct pnp_dev *dev,
  843. struct acpi_resource *resource,
  844. struct resource *p)
  845. {
  846. struct acpi_resource_io *io = &resource->data.io;
  847. if (pnp_resource_enabled(p)) {
  848. /* Note: pnp_assign_port copies pnp_port->flags into p->flags */
  849. io->io_decode = (p->flags & IORESOURCE_IO_16BIT_ADDR) ?
  850. ACPI_DECODE_16 : ACPI_DECODE_10;
  851. io->minimum = p->start;
  852. io->maximum = p->end;
  853. io->alignment = 0; /* Correct? */
  854. io->address_length = p->end - p->start + 1;
  855. } else {
  856. io->minimum = 0;
  857. io->address_length = 0;
  858. }
  859. pnp_dbg(&dev->dev, " encode io %#x-%#x decode %#x\n", io->minimum,
  860. io->minimum + io->address_length - 1, io->io_decode);
  861. }
  862. static void pnpacpi_encode_fixed_io(struct pnp_dev *dev,
  863. struct acpi_resource *resource,
  864. struct resource *p)
  865. {
  866. struct acpi_resource_fixed_io *fixed_io = &resource->data.fixed_io;
  867. if (pnp_resource_enabled(p)) {
  868. fixed_io->address = p->start;
  869. fixed_io->address_length = p->end - p->start + 1;
  870. } else {
  871. fixed_io->address = 0;
  872. fixed_io->address_length = 0;
  873. }
  874. pnp_dbg(&dev->dev, " encode fixed_io %#x-%#x\n", fixed_io->address,
  875. fixed_io->address + fixed_io->address_length - 1);
  876. }
  877. static void pnpacpi_encode_mem24(struct pnp_dev *dev,
  878. struct acpi_resource *resource,
  879. struct resource *p)
  880. {
  881. struct acpi_resource_memory24 *memory24 = &resource->data.memory24;
  882. if (pnp_resource_enabled(p)) {
  883. /* Note: pnp_assign_mem copies pnp_mem->flags into p->flags */
  884. memory24->write_protect = p->flags & IORESOURCE_MEM_WRITEABLE ?
  885. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  886. memory24->minimum = p->start;
  887. memory24->maximum = p->end;
  888. memory24->alignment = 0;
  889. memory24->address_length = p->end - p->start + 1;
  890. } else {
  891. memory24->minimum = 0;
  892. memory24->address_length = 0;
  893. }
  894. pnp_dbg(&dev->dev, " encode mem24 %#x-%#x write_protect %#x\n",
  895. memory24->minimum,
  896. memory24->minimum + memory24->address_length - 1,
  897. memory24->write_protect);
  898. }
  899. static void pnpacpi_encode_mem32(struct pnp_dev *dev,
  900. struct acpi_resource *resource,
  901. struct resource *p)
  902. {
  903. struct acpi_resource_memory32 *memory32 = &resource->data.memory32;
  904. if (pnp_resource_enabled(p)) {
  905. memory32->write_protect = p->flags & IORESOURCE_MEM_WRITEABLE ?
  906. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  907. memory32->minimum = p->start;
  908. memory32->maximum = p->end;
  909. memory32->alignment = 0;
  910. memory32->address_length = p->end - p->start + 1;
  911. } else {
  912. memory32->minimum = 0;
  913. memory32->alignment = 0;
  914. }
  915. pnp_dbg(&dev->dev, " encode mem32 %#x-%#x write_protect %#x\n",
  916. memory32->minimum,
  917. memory32->minimum + memory32->address_length - 1,
  918. memory32->write_protect);
  919. }
  920. static void pnpacpi_encode_fixed_mem32(struct pnp_dev *dev,
  921. struct acpi_resource *resource,
  922. struct resource *p)
  923. {
  924. struct acpi_resource_fixed_memory32 *fixed_memory32 = &resource->data.fixed_memory32;
  925. if (pnp_resource_enabled(p)) {
  926. fixed_memory32->write_protect =
  927. p->flags & IORESOURCE_MEM_WRITEABLE ?
  928. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  929. fixed_memory32->address = p->start;
  930. fixed_memory32->address_length = p->end - p->start + 1;
  931. } else {
  932. fixed_memory32->address = 0;
  933. fixed_memory32->address_length = 0;
  934. }
  935. pnp_dbg(&dev->dev, " encode fixed_mem32 %#x-%#x write_protect %#x\n",
  936. fixed_memory32->address,
  937. fixed_memory32->address + fixed_memory32->address_length - 1,
  938. fixed_memory32->write_protect);
  939. }
  940. int pnpacpi_encode_resources(struct pnp_dev *dev, struct acpi_buffer *buffer)
  941. {
  942. int i = 0;
  943. /* pnpacpi_build_resource_template allocates extra mem */
  944. int res_cnt = (buffer->length - 1) / sizeof(struct acpi_resource) - 1;
  945. struct acpi_resource *resource = buffer->pointer;
  946. int port = 0, irq = 0, dma = 0, mem = 0;
  947. pnp_dbg(&dev->dev, "encode %d resources\n", res_cnt);
  948. while (i < res_cnt) {
  949. switch (resource->type) {
  950. case ACPI_RESOURCE_TYPE_IRQ:
  951. pnpacpi_encode_irq(dev, resource,
  952. pnp_get_resource(dev, IORESOURCE_IRQ, irq));
  953. irq++;
  954. break;
  955. case ACPI_RESOURCE_TYPE_DMA:
  956. pnpacpi_encode_dma(dev, resource,
  957. pnp_get_resource(dev, IORESOURCE_DMA, dma));
  958. dma++;
  959. break;
  960. case ACPI_RESOURCE_TYPE_IO:
  961. pnpacpi_encode_io(dev, resource,
  962. pnp_get_resource(dev, IORESOURCE_IO, port));
  963. port++;
  964. break;
  965. case ACPI_RESOURCE_TYPE_FIXED_IO:
  966. pnpacpi_encode_fixed_io(dev, resource,
  967. pnp_get_resource(dev, IORESOURCE_IO, port));
  968. port++;
  969. break;
  970. case ACPI_RESOURCE_TYPE_MEMORY24:
  971. pnpacpi_encode_mem24(dev, resource,
  972. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  973. mem++;
  974. break;
  975. case ACPI_RESOURCE_TYPE_MEMORY32:
  976. pnpacpi_encode_mem32(dev, resource,
  977. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  978. mem++;
  979. break;
  980. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  981. pnpacpi_encode_fixed_mem32(dev, resource,
  982. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  983. mem++;
  984. break;
  985. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  986. pnpacpi_encode_ext_irq(dev, resource,
  987. pnp_get_resource(dev, IORESOURCE_IRQ, irq));
  988. irq++;
  989. break;
  990. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  991. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  992. case ACPI_RESOURCE_TYPE_VENDOR:
  993. case ACPI_RESOURCE_TYPE_END_TAG:
  994. case ACPI_RESOURCE_TYPE_ADDRESS16:
  995. case ACPI_RESOURCE_TYPE_ADDRESS32:
  996. case ACPI_RESOURCE_TYPE_ADDRESS64:
  997. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  998. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  999. default: /* other type */
  1000. dev_warn(&dev->dev, "can't encode unknown resource "
  1001. "type %d\n", resource->type);
  1002. return -EINVAL;
  1003. }
  1004. resource++;
  1005. i++;
  1006. }
  1007. return 0;
  1008. }