rsparser.c 22 KB

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