rsparser.c 28 KB

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