rsparser.c 25 KB

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