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. pnp_warn("IRQ %d override to %s, %s",
  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. pnp_warn("PnPACPI: failed to convert resource type %d",
  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. pnp_warn("PnPACPI: unknown resource type %d", res->type);
  361. return AE_ERROR;
  362. }
  363. return AE_OK;
  364. }
  365. acpi_status pnpacpi_parse_allocated_resource(struct pnp_dev *dev)
  366. {
  367. acpi_handle handle = dev->data;
  368. dev_dbg(&dev->dev, "parse allocated resources\n");
  369. /* Blank the resource table values */
  370. pnp_init_resource_table(&dev->res);
  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. pnp_warn("PnPACPI: more than one EndDependentFn");
  593. return AE_ERROR;
  594. }
  595. parse_data->option = parse_data->option_independent;
  596. parse_data->option_independent = NULL;
  597. dev_dbg(&dev->dev, "end dependent options\n");
  598. break;
  599. case ACPI_RESOURCE_TYPE_IO:
  600. pnpacpi_parse_port_option(dev, option, &res->data.io);
  601. break;
  602. case ACPI_RESOURCE_TYPE_FIXED_IO:
  603. pnpacpi_parse_fixed_port_option(dev, option,
  604. &res->data.fixed_io);
  605. break;
  606. case ACPI_RESOURCE_TYPE_VENDOR:
  607. case ACPI_RESOURCE_TYPE_END_TAG:
  608. break;
  609. case ACPI_RESOURCE_TYPE_MEMORY24:
  610. pnpacpi_parse_mem24_option(dev, option, &res->data.memory24);
  611. break;
  612. case ACPI_RESOURCE_TYPE_MEMORY32:
  613. pnpacpi_parse_mem32_option(dev, option, &res->data.memory32);
  614. break;
  615. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  616. pnpacpi_parse_fixed_mem32_option(dev, option,
  617. &res->data.fixed_memory32);
  618. break;
  619. case ACPI_RESOURCE_TYPE_ADDRESS16:
  620. case ACPI_RESOURCE_TYPE_ADDRESS32:
  621. case ACPI_RESOURCE_TYPE_ADDRESS64:
  622. pnpacpi_parse_address_option(dev, option, res);
  623. break;
  624. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  625. break;
  626. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  627. pnpacpi_parse_ext_irq_option(dev, option,
  628. &res->data.extended_irq);
  629. break;
  630. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  631. break;
  632. default:
  633. pnp_warn("PnPACPI: unknown resource type %d", res->type);
  634. return AE_ERROR;
  635. }
  636. return AE_OK;
  637. }
  638. acpi_status __init pnpacpi_parse_resource_option_data(struct pnp_dev *dev)
  639. {
  640. acpi_handle handle = dev->data;
  641. acpi_status status;
  642. struct acpipnp_parse_option_s parse_data;
  643. dev_dbg(&dev->dev, "parse resource options\n");
  644. parse_data.option = pnp_register_independent_option(dev);
  645. if (!parse_data.option)
  646. return AE_ERROR;
  647. parse_data.option_independent = parse_data.option;
  648. parse_data.dev = dev;
  649. status = acpi_walk_resources(handle, METHOD_NAME__PRS,
  650. pnpacpi_option_resource, &parse_data);
  651. return status;
  652. }
  653. static int pnpacpi_supported_resource(struct acpi_resource *res)
  654. {
  655. switch (res->type) {
  656. case ACPI_RESOURCE_TYPE_IRQ:
  657. case ACPI_RESOURCE_TYPE_DMA:
  658. case ACPI_RESOURCE_TYPE_IO:
  659. case ACPI_RESOURCE_TYPE_FIXED_IO:
  660. case ACPI_RESOURCE_TYPE_MEMORY24:
  661. case ACPI_RESOURCE_TYPE_MEMORY32:
  662. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  663. case ACPI_RESOURCE_TYPE_ADDRESS16:
  664. case ACPI_RESOURCE_TYPE_ADDRESS32:
  665. case ACPI_RESOURCE_TYPE_ADDRESS64:
  666. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  667. return 1;
  668. }
  669. return 0;
  670. }
  671. /*
  672. * Set resource
  673. */
  674. static acpi_status pnpacpi_count_resources(struct acpi_resource *res,
  675. void *data)
  676. {
  677. int *res_cnt = data;
  678. if (pnpacpi_supported_resource(res))
  679. (*res_cnt)++;
  680. return AE_OK;
  681. }
  682. static acpi_status pnpacpi_type_resources(struct acpi_resource *res, void *data)
  683. {
  684. struct acpi_resource **resource = data;
  685. if (pnpacpi_supported_resource(res)) {
  686. (*resource)->type = res->type;
  687. (*resource)->length = sizeof(struct acpi_resource);
  688. (*resource)++;
  689. }
  690. return AE_OK;
  691. }
  692. int pnpacpi_build_resource_template(struct pnp_dev *dev,
  693. struct acpi_buffer *buffer)
  694. {
  695. acpi_handle handle = dev->data;
  696. struct acpi_resource *resource;
  697. int res_cnt = 0;
  698. acpi_status status;
  699. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  700. pnpacpi_count_resources, &res_cnt);
  701. if (ACPI_FAILURE(status)) {
  702. pnp_err("Evaluate _CRS failed");
  703. return -EINVAL;
  704. }
  705. if (!res_cnt)
  706. return -EINVAL;
  707. buffer->length = sizeof(struct acpi_resource) * (res_cnt + 1) + 1;
  708. buffer->pointer = kzalloc(buffer->length - 1, GFP_KERNEL);
  709. if (!buffer->pointer)
  710. return -ENOMEM;
  711. resource = (struct acpi_resource *)buffer->pointer;
  712. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  713. pnpacpi_type_resources, &resource);
  714. if (ACPI_FAILURE(status)) {
  715. kfree(buffer->pointer);
  716. pnp_err("Evaluate _CRS failed");
  717. return -EINVAL;
  718. }
  719. /* resource will pointer the end resource now */
  720. resource->type = ACPI_RESOURCE_TYPE_END_TAG;
  721. return 0;
  722. }
  723. static void pnpacpi_encode_irq(struct pnp_dev *dev,
  724. struct acpi_resource *resource,
  725. struct resource *p)
  726. {
  727. struct acpi_resource_irq *irq = &resource->data.irq;
  728. int triggering, polarity;
  729. decode_irq_flags(p->flags & IORESOURCE_BITS, &triggering, &polarity);
  730. irq->triggering = triggering;
  731. irq->polarity = polarity;
  732. if (triggering == ACPI_EDGE_SENSITIVE)
  733. irq->sharable = ACPI_EXCLUSIVE;
  734. else
  735. irq->sharable = ACPI_SHARED;
  736. irq->interrupt_count = 1;
  737. irq->interrupts[0] = p->start;
  738. dev_dbg(&dev->dev, " encode irq %d %s %s %s\n", (int) p->start,
  739. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  740. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  741. irq->sharable == ACPI_SHARED ? "shared" : "exclusive");
  742. }
  743. static void pnpacpi_encode_ext_irq(struct pnp_dev *dev,
  744. struct acpi_resource *resource,
  745. struct resource *p)
  746. {
  747. struct acpi_resource_extended_irq *extended_irq = &resource->data.extended_irq;
  748. int triggering, polarity;
  749. decode_irq_flags(p->flags & IORESOURCE_BITS, &triggering, &polarity);
  750. extended_irq->producer_consumer = ACPI_CONSUMER;
  751. extended_irq->triggering = triggering;
  752. extended_irq->polarity = polarity;
  753. if (triggering == ACPI_EDGE_SENSITIVE)
  754. extended_irq->sharable = ACPI_EXCLUSIVE;
  755. else
  756. extended_irq->sharable = ACPI_SHARED;
  757. extended_irq->interrupt_count = 1;
  758. extended_irq->interrupts[0] = p->start;
  759. dev_dbg(&dev->dev, " encode irq %d %s %s %s\n", (int) p->start,
  760. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  761. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  762. extended_irq->sharable == ACPI_SHARED ? "shared" : "exclusive");
  763. }
  764. static void pnpacpi_encode_dma(struct pnp_dev *dev,
  765. struct acpi_resource *resource,
  766. struct resource *p)
  767. {
  768. struct acpi_resource_dma *dma = &resource->data.dma;
  769. /* Note: pnp_assign_dma will copy pnp_dma->flags into p->flags */
  770. switch (p->flags & IORESOURCE_DMA_SPEED_MASK) {
  771. case IORESOURCE_DMA_TYPEA:
  772. dma->type = ACPI_TYPE_A;
  773. break;
  774. case IORESOURCE_DMA_TYPEB:
  775. dma->type = ACPI_TYPE_B;
  776. break;
  777. case IORESOURCE_DMA_TYPEF:
  778. dma->type = ACPI_TYPE_F;
  779. break;
  780. default:
  781. dma->type = ACPI_COMPATIBILITY;
  782. }
  783. switch (p->flags & IORESOURCE_DMA_TYPE_MASK) {
  784. case IORESOURCE_DMA_8BIT:
  785. dma->transfer = ACPI_TRANSFER_8;
  786. break;
  787. case IORESOURCE_DMA_8AND16BIT:
  788. dma->transfer = ACPI_TRANSFER_8_16;
  789. break;
  790. default:
  791. dma->transfer = ACPI_TRANSFER_16;
  792. }
  793. dma->bus_master = !!(p->flags & IORESOURCE_DMA_MASTER);
  794. dma->channel_count = 1;
  795. dma->channels[0] = p->start;
  796. dev_dbg(&dev->dev, " encode dma %d "
  797. "type %#x transfer %#x master %d\n",
  798. (int) p->start, dma->type, dma->transfer, dma->bus_master);
  799. }
  800. static void pnpacpi_encode_io(struct pnp_dev *dev,
  801. struct acpi_resource *resource,
  802. struct resource *p)
  803. {
  804. struct acpi_resource_io *io = &resource->data.io;
  805. /* Note: pnp_assign_port will copy pnp_port->flags into p->flags */
  806. io->io_decode = (p->flags & PNP_PORT_FLAG_16BITADDR) ?
  807. ACPI_DECODE_16 : ACPI_DECODE_10;
  808. io->minimum = p->start;
  809. io->maximum = p->end;
  810. io->alignment = 0; /* Correct? */
  811. io->address_length = p->end - p->start + 1;
  812. dev_dbg(&dev->dev, " encode io %#llx-%#llx decode %#x\n",
  813. (unsigned long long) p->start, (unsigned long long) p->end,
  814. io->io_decode);
  815. }
  816. static void pnpacpi_encode_fixed_io(struct pnp_dev *dev,
  817. struct acpi_resource *resource,
  818. struct resource *p)
  819. {
  820. struct acpi_resource_fixed_io *fixed_io = &resource->data.fixed_io;
  821. fixed_io->address = p->start;
  822. fixed_io->address_length = p->end - p->start + 1;
  823. dev_dbg(&dev->dev, " encode fixed_io %#llx-%#llx\n",
  824. (unsigned long long) p->start, (unsigned long long) p->end);
  825. }
  826. static void pnpacpi_encode_mem24(struct pnp_dev *dev,
  827. struct acpi_resource *resource,
  828. struct resource *p)
  829. {
  830. struct acpi_resource_memory24 *memory24 = &resource->data.memory24;
  831. /* Note: pnp_assign_mem will copy pnp_mem->flags into p->flags */
  832. memory24->write_protect =
  833. (p->flags & IORESOURCE_MEM_WRITEABLE) ?
  834. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  835. memory24->minimum = p->start;
  836. memory24->maximum = p->end;
  837. memory24->alignment = 0;
  838. memory24->address_length = p->end - p->start + 1;
  839. dev_dbg(&dev->dev, " encode mem24 %#llx-%#llx write_protect %#x\n",
  840. (unsigned long long) p->start, (unsigned long long) p->end,
  841. memory24->write_protect);
  842. }
  843. static void pnpacpi_encode_mem32(struct pnp_dev *dev,
  844. struct acpi_resource *resource,
  845. struct resource *p)
  846. {
  847. struct acpi_resource_memory32 *memory32 = &resource->data.memory32;
  848. memory32->write_protect =
  849. (p->flags & IORESOURCE_MEM_WRITEABLE) ?
  850. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  851. memory32->minimum = p->start;
  852. memory32->maximum = p->end;
  853. memory32->alignment = 0;
  854. memory32->address_length = p->end - p->start + 1;
  855. dev_dbg(&dev->dev, " encode mem32 %#llx-%#llx write_protect %#x\n",
  856. (unsigned long long) p->start, (unsigned long long) p->end,
  857. memory32->write_protect);
  858. }
  859. static void pnpacpi_encode_fixed_mem32(struct pnp_dev *dev,
  860. struct acpi_resource *resource,
  861. struct resource *p)
  862. {
  863. struct acpi_resource_fixed_memory32 *fixed_memory32 = &resource->data.fixed_memory32;
  864. fixed_memory32->write_protect =
  865. (p->flags & IORESOURCE_MEM_WRITEABLE) ?
  866. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  867. fixed_memory32->address = p->start;
  868. fixed_memory32->address_length = p->end - p->start + 1;
  869. dev_dbg(&dev->dev, " encode fixed_mem32 %#llx-%#llx "
  870. "write_protect %#x\n",
  871. (unsigned long long) p->start, (unsigned long long) p->end,
  872. fixed_memory32->write_protect);
  873. }
  874. int pnpacpi_encode_resources(struct pnp_dev *dev, struct acpi_buffer *buffer)
  875. {
  876. struct pnp_resource_table *res_table = &dev->res;
  877. int i = 0;
  878. /* pnpacpi_build_resource_template allocates extra mem */
  879. int res_cnt = (buffer->length - 1) / sizeof(struct acpi_resource) - 1;
  880. struct acpi_resource *resource = buffer->pointer;
  881. int port = 0, irq = 0, dma = 0, mem = 0;
  882. dev_dbg(&dev->dev, "encode %d resources\n", res_cnt);
  883. while (i < res_cnt) {
  884. switch (resource->type) {
  885. case ACPI_RESOURCE_TYPE_IRQ:
  886. pnpacpi_encode_irq(dev, resource,
  887. &res_table->irq_resource[irq]);
  888. irq++;
  889. break;
  890. case ACPI_RESOURCE_TYPE_DMA:
  891. pnpacpi_encode_dma(dev, resource,
  892. &res_table->dma_resource[dma]);
  893. dma++;
  894. break;
  895. case ACPI_RESOURCE_TYPE_IO:
  896. pnpacpi_encode_io(dev, resource,
  897. &res_table->port_resource[port]);
  898. port++;
  899. break;
  900. case ACPI_RESOURCE_TYPE_FIXED_IO:
  901. pnpacpi_encode_fixed_io(dev, resource,
  902. &res_table->
  903. port_resource[port]);
  904. port++;
  905. break;
  906. case ACPI_RESOURCE_TYPE_MEMORY24:
  907. pnpacpi_encode_mem24(dev, resource,
  908. &res_table->mem_resource[mem]);
  909. mem++;
  910. break;
  911. case ACPI_RESOURCE_TYPE_MEMORY32:
  912. pnpacpi_encode_mem32(dev, resource,
  913. &res_table->mem_resource[mem]);
  914. mem++;
  915. break;
  916. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  917. pnpacpi_encode_fixed_mem32(dev, resource,
  918. &res_table->
  919. mem_resource[mem]);
  920. mem++;
  921. break;
  922. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  923. pnpacpi_encode_ext_irq(dev, resource,
  924. &res_table->irq_resource[irq]);
  925. irq++;
  926. break;
  927. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  928. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  929. case ACPI_RESOURCE_TYPE_VENDOR:
  930. case ACPI_RESOURCE_TYPE_END_TAG:
  931. case ACPI_RESOURCE_TYPE_ADDRESS16:
  932. case ACPI_RESOURCE_TYPE_ADDRESS32:
  933. case ACPI_RESOURCE_TYPE_ADDRESS64:
  934. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  935. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  936. default: /* other type */
  937. pnp_warn("unknown resource type %d", resource->type);
  938. return -EINVAL;
  939. }
  940. resource++;
  941. i++;
  942. }
  943. return 0;
  944. }