rsparser.c 24 KB

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