rsparser.c 24 KB

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