rsparser.c 28 KB

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