rsparser.c 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171
  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. * Copyright (C) 2008 Hewlett-Packard Development Company, L.P.
  7. * Bjorn Helgaas <bjorn.helgaas@hp.com>
  8. *
  9. * This program is free software; you can redistribute it and/or modify it
  10. * under the terms of the GNU General Public License as published by the
  11. * Free Software Foundation; either version 2, or (at your option) any
  12. * later version.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  22. */
  23. #include <linux/kernel.h>
  24. #include <linux/acpi.h>
  25. #include <linux/pci.h>
  26. #include <linux/pnp.h>
  27. #include "../base.h"
  28. #include "pnpacpi.h"
  29. #ifdef CONFIG_IA64
  30. #define valid_IRQ(i) (1)
  31. #else
  32. #define valid_IRQ(i) (((i) != 0) && ((i) != 2))
  33. #endif
  34. /*
  35. * Allocated Resources
  36. */
  37. static int irq_flags(int triggering, int polarity, int shareable)
  38. {
  39. int flags;
  40. if (triggering == ACPI_LEVEL_SENSITIVE) {
  41. if (polarity == ACPI_ACTIVE_LOW)
  42. flags = IORESOURCE_IRQ_LOWLEVEL;
  43. else
  44. flags = IORESOURCE_IRQ_HIGHLEVEL;
  45. } else {
  46. if (polarity == ACPI_ACTIVE_LOW)
  47. flags = IORESOURCE_IRQ_LOWEDGE;
  48. else
  49. flags = IORESOURCE_IRQ_HIGHEDGE;
  50. }
  51. if (shareable == ACPI_SHARED)
  52. flags |= IORESOURCE_IRQ_SHAREABLE;
  53. return flags;
  54. }
  55. static void decode_irq_flags(struct pnp_dev *dev, int flags, int *triggering,
  56. int *polarity, int *shareable)
  57. {
  58. switch (flags & (IORESOURCE_IRQ_LOWLEVEL | IORESOURCE_IRQ_HIGHLEVEL |
  59. IORESOURCE_IRQ_LOWEDGE | IORESOURCE_IRQ_HIGHEDGE)) {
  60. case IORESOURCE_IRQ_LOWLEVEL:
  61. *triggering = ACPI_LEVEL_SENSITIVE;
  62. *polarity = ACPI_ACTIVE_LOW;
  63. break;
  64. case IORESOURCE_IRQ_HIGHLEVEL:
  65. *triggering = ACPI_LEVEL_SENSITIVE;
  66. *polarity = ACPI_ACTIVE_HIGH;
  67. break;
  68. case IORESOURCE_IRQ_LOWEDGE:
  69. *triggering = ACPI_EDGE_SENSITIVE;
  70. *polarity = ACPI_ACTIVE_LOW;
  71. break;
  72. case IORESOURCE_IRQ_HIGHEDGE:
  73. *triggering = ACPI_EDGE_SENSITIVE;
  74. *polarity = ACPI_ACTIVE_HIGH;
  75. break;
  76. default:
  77. dev_err(&dev->dev, "can't encode invalid IRQ mode %#x\n",
  78. flags);
  79. *triggering = ACPI_EDGE_SENSITIVE;
  80. *polarity = ACPI_ACTIVE_HIGH;
  81. break;
  82. }
  83. if (flags & IORESOURCE_IRQ_SHAREABLE)
  84. *shareable = ACPI_SHARED;
  85. else
  86. *shareable = ACPI_EXCLUSIVE;
  87. }
  88. static void pnpacpi_parse_allocated_irqresource(struct pnp_dev *dev,
  89. u32 gsi, int triggering,
  90. int polarity, int shareable)
  91. {
  92. int irq, flags;
  93. int p, t;
  94. if (!valid_IRQ(gsi)) {
  95. pnp_add_irq_resource(dev, gsi, IORESOURCE_DISABLED);
  96. return;
  97. }
  98. /*
  99. * in IO-APIC mode, use overrided attribute. Two reasons:
  100. * 1. BIOS bug in DSDT
  101. * 2. BIOS uses IO-APIC mode Interrupt Source Override
  102. */
  103. if (!acpi_get_override_irq(gsi, &t, &p)) {
  104. t = t ? ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE;
  105. p = p ? ACPI_ACTIVE_LOW : ACPI_ACTIVE_HIGH;
  106. if (triggering != t || polarity != p) {
  107. dev_warn(&dev->dev, "IRQ %d override to %s, %s\n",
  108. gsi, t ? "edge":"level", p ? "low":"high");
  109. triggering = t;
  110. polarity = p;
  111. }
  112. }
  113. flags = irq_flags(triggering, polarity, shareable);
  114. irq = acpi_register_gsi(&dev->dev, gsi, triggering, polarity);
  115. if (irq >= 0)
  116. pcibios_penalize_isa_irq(irq, 1);
  117. else
  118. flags |= IORESOURCE_DISABLED;
  119. pnp_add_irq_resource(dev, irq, flags);
  120. }
  121. static int dma_flags(struct pnp_dev *dev, int type, int bus_master,
  122. int transfer)
  123. {
  124. int flags = 0;
  125. if (bus_master)
  126. flags |= IORESOURCE_DMA_MASTER;
  127. switch (type) {
  128. case ACPI_COMPATIBILITY:
  129. flags |= IORESOURCE_DMA_COMPATIBLE;
  130. break;
  131. case ACPI_TYPE_A:
  132. flags |= IORESOURCE_DMA_TYPEA;
  133. break;
  134. case ACPI_TYPE_B:
  135. flags |= IORESOURCE_DMA_TYPEB;
  136. break;
  137. case ACPI_TYPE_F:
  138. flags |= IORESOURCE_DMA_TYPEF;
  139. break;
  140. default:
  141. /* Set a default value ? */
  142. flags |= IORESOURCE_DMA_COMPATIBLE;
  143. dev_err(&dev->dev, "invalid DMA type %d\n", type);
  144. }
  145. switch (transfer) {
  146. case ACPI_TRANSFER_8:
  147. flags |= IORESOURCE_DMA_8BIT;
  148. break;
  149. case ACPI_TRANSFER_8_16:
  150. flags |= IORESOURCE_DMA_8AND16BIT;
  151. break;
  152. case ACPI_TRANSFER_16:
  153. flags |= IORESOURCE_DMA_16BIT;
  154. break;
  155. default:
  156. /* Set a default value ? */
  157. flags |= IORESOURCE_DMA_8AND16BIT;
  158. dev_err(&dev->dev, "invalid DMA transfer type %d\n", transfer);
  159. }
  160. return flags;
  161. }
  162. static void pnpacpi_parse_allocated_ioresource(struct pnp_dev *dev, u64 start,
  163. u64 len, int io_decode)
  164. {
  165. int flags = 0;
  166. u64 end = start + len - 1;
  167. if (io_decode == ACPI_DECODE_16)
  168. flags |= IORESOURCE_IO_16BIT_ADDR;
  169. if (len == 0 || end >= 0x10003)
  170. flags |= IORESOURCE_DISABLED;
  171. pnp_add_io_resource(dev, start, end, flags);
  172. }
  173. /*
  174. * Device CSRs that do not appear in PCI config space should be described
  175. * via ACPI. This would normally be done with Address Space Descriptors
  176. * marked as "consumer-only," but old versions of Windows and Linux ignore
  177. * the producer/consumer flag, so HP invented a vendor-defined resource to
  178. * describe the location and size of CSR space.
  179. */
  180. static struct acpi_vendor_uuid hp_ccsr_uuid = {
  181. .subtype = 2,
  182. .data = { 0xf9, 0xad, 0xe9, 0x69, 0x4f, 0x92, 0x5f, 0xab, 0xf6, 0x4a,
  183. 0x24, 0xd2, 0x01, 0x37, 0x0e, 0xad },
  184. };
  185. static int vendor_resource_matches(struct pnp_dev *dev,
  186. struct acpi_resource_vendor_typed *vendor,
  187. struct acpi_vendor_uuid *match,
  188. int expected_len)
  189. {
  190. int uuid_len = sizeof(vendor->uuid);
  191. u8 uuid_subtype = vendor->uuid_subtype;
  192. u8 *uuid = vendor->uuid;
  193. int actual_len;
  194. /* byte_length includes uuid_subtype and uuid */
  195. actual_len = vendor->byte_length - uuid_len - 1;
  196. if (uuid_subtype == match->subtype &&
  197. uuid_len == sizeof(match->data) &&
  198. memcmp(uuid, match->data, uuid_len) == 0) {
  199. if (expected_len && expected_len != actual_len) {
  200. dev_err(&dev->dev, "wrong vendor descriptor size; "
  201. "expected %d, found %d bytes\n",
  202. expected_len, actual_len);
  203. return 0;
  204. }
  205. return 1;
  206. }
  207. return 0;
  208. }
  209. static void pnpacpi_parse_allocated_vendor(struct pnp_dev *dev,
  210. struct acpi_resource_vendor_typed *vendor)
  211. {
  212. if (vendor_resource_matches(dev, vendor, &hp_ccsr_uuid, 16)) {
  213. u64 start, length;
  214. memcpy(&start, vendor->byte_data, sizeof(start));
  215. memcpy(&length, vendor->byte_data + 8, sizeof(length));
  216. pnp_add_mem_resource(dev, start, start + length - 1, 0);
  217. }
  218. }
  219. static void pnpacpi_parse_allocated_memresource(struct pnp_dev *dev,
  220. u64 start, u64 len,
  221. int write_protect)
  222. {
  223. int flags = 0;
  224. u64 end = start + len - 1;
  225. if (len == 0)
  226. flags |= IORESOURCE_DISABLED;
  227. if (write_protect == ACPI_READ_WRITE_MEMORY)
  228. flags |= IORESOURCE_MEM_WRITEABLE;
  229. pnp_add_mem_resource(dev, start, end, flags);
  230. }
  231. static void pnpacpi_parse_allocated_address_space(struct pnp_dev *dev,
  232. struct acpi_resource *res)
  233. {
  234. struct acpi_resource_address64 addr, *p = &addr;
  235. acpi_status status;
  236. status = acpi_resource_to_address64(res, p);
  237. if (!ACPI_SUCCESS(status)) {
  238. dev_warn(&dev->dev, "failed to convert resource type %d\n",
  239. res->type);
  240. return;
  241. }
  242. if (p->producer_consumer == ACPI_PRODUCER)
  243. return;
  244. if (p->resource_type == ACPI_MEMORY_RANGE)
  245. pnpacpi_parse_allocated_memresource(dev,
  246. p->minimum, p->address_length,
  247. p->info.mem.write_protect);
  248. else if (p->resource_type == ACPI_IO_RANGE)
  249. pnpacpi_parse_allocated_ioresource(dev,
  250. p->minimum, p->address_length,
  251. p->granularity == 0xfff ? ACPI_DECODE_10 :
  252. ACPI_DECODE_16);
  253. }
  254. static void pnpacpi_parse_allocated_ext_address_space(struct pnp_dev *dev,
  255. struct acpi_resource *res)
  256. {
  257. struct acpi_resource_extended_address64 *p = &res->data.ext_address64;
  258. if (p->producer_consumer == ACPI_PRODUCER)
  259. return;
  260. if (p->resource_type == ACPI_MEMORY_RANGE)
  261. pnpacpi_parse_allocated_memresource(dev,
  262. p->minimum, p->address_length,
  263. p->info.mem.write_protect);
  264. else if (p->resource_type == ACPI_IO_RANGE)
  265. pnpacpi_parse_allocated_ioresource(dev,
  266. p->minimum, p->address_length,
  267. p->granularity == 0xfff ? ACPI_DECODE_10 :
  268. ACPI_DECODE_16);
  269. }
  270. static acpi_status pnpacpi_allocated_resource(struct acpi_resource *res,
  271. void *data)
  272. {
  273. struct pnp_dev *dev = data;
  274. struct acpi_resource_irq *irq;
  275. struct acpi_resource_dma *dma;
  276. struct acpi_resource_io *io;
  277. struct acpi_resource_fixed_io *fixed_io;
  278. struct acpi_resource_vendor_typed *vendor_typed;
  279. struct acpi_resource_memory24 *memory24;
  280. struct acpi_resource_memory32 *memory32;
  281. struct acpi_resource_fixed_memory32 *fixed_memory32;
  282. struct acpi_resource_extended_irq *extended_irq;
  283. int i, flags;
  284. switch (res->type) {
  285. case ACPI_RESOURCE_TYPE_IRQ:
  286. /*
  287. * Per spec, only one interrupt per descriptor is allowed in
  288. * _CRS, but some firmware violates this, so parse them all.
  289. */
  290. irq = &res->data.irq;
  291. if (irq->interrupt_count == 0)
  292. pnp_add_irq_resource(dev, 0, IORESOURCE_DISABLED);
  293. else {
  294. for (i = 0; i < irq->interrupt_count; i++) {
  295. pnpacpi_parse_allocated_irqresource(dev,
  296. irq->interrupts[i],
  297. irq->triggering,
  298. irq->polarity,
  299. irq->sharable);
  300. }
  301. /*
  302. * The IRQ encoder puts a single interrupt in each
  303. * descriptor, so if a _CRS descriptor has more than
  304. * one interrupt, we won't be able to re-encode it.
  305. */
  306. if (pnp_can_write(dev) && irq->interrupt_count > 1) {
  307. dev_warn(&dev->dev, "multiple interrupts in "
  308. "_CRS descriptor; configuration can't "
  309. "be changed\n");
  310. dev->capabilities &= ~PNP_WRITE;
  311. }
  312. }
  313. break;
  314. case ACPI_RESOURCE_TYPE_DMA:
  315. dma = &res->data.dma;
  316. if (dma->channel_count > 0 && dma->channels[0] != (u8) -1)
  317. flags = dma_flags(dev, dma->type, dma->bus_master,
  318. dma->transfer);
  319. else
  320. flags = IORESOURCE_DISABLED;
  321. pnp_add_dma_resource(dev, dma->channels[0], flags);
  322. break;
  323. case ACPI_RESOURCE_TYPE_IO:
  324. io = &res->data.io;
  325. pnpacpi_parse_allocated_ioresource(dev,
  326. io->minimum,
  327. io->address_length,
  328. io->io_decode);
  329. break;
  330. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  331. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  332. break;
  333. case ACPI_RESOURCE_TYPE_FIXED_IO:
  334. fixed_io = &res->data.fixed_io;
  335. pnpacpi_parse_allocated_ioresource(dev,
  336. fixed_io->address,
  337. fixed_io->address_length,
  338. ACPI_DECODE_10);
  339. break;
  340. case ACPI_RESOURCE_TYPE_VENDOR:
  341. vendor_typed = &res->data.vendor_typed;
  342. pnpacpi_parse_allocated_vendor(dev, vendor_typed);
  343. break;
  344. case ACPI_RESOURCE_TYPE_END_TAG:
  345. break;
  346. case ACPI_RESOURCE_TYPE_MEMORY24:
  347. memory24 = &res->data.memory24;
  348. pnpacpi_parse_allocated_memresource(dev,
  349. memory24->minimum,
  350. memory24->address_length,
  351. memory24->write_protect);
  352. break;
  353. case ACPI_RESOURCE_TYPE_MEMORY32:
  354. memory32 = &res->data.memory32;
  355. pnpacpi_parse_allocated_memresource(dev,
  356. memory32->minimum,
  357. memory32->address_length,
  358. memory32->write_protect);
  359. break;
  360. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  361. fixed_memory32 = &res->data.fixed_memory32;
  362. pnpacpi_parse_allocated_memresource(dev,
  363. fixed_memory32->address,
  364. fixed_memory32->address_length,
  365. fixed_memory32->write_protect);
  366. break;
  367. case ACPI_RESOURCE_TYPE_ADDRESS16:
  368. case ACPI_RESOURCE_TYPE_ADDRESS32:
  369. case ACPI_RESOURCE_TYPE_ADDRESS64:
  370. pnpacpi_parse_allocated_address_space(dev, res);
  371. break;
  372. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  373. pnpacpi_parse_allocated_ext_address_space(dev, res);
  374. break;
  375. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  376. extended_irq = &res->data.extended_irq;
  377. if (extended_irq->interrupt_count == 0)
  378. pnp_add_irq_resource(dev, 0, IORESOURCE_DISABLED);
  379. else {
  380. for (i = 0; i < extended_irq->interrupt_count; i++) {
  381. pnpacpi_parse_allocated_irqresource(dev,
  382. extended_irq->interrupts[i],
  383. extended_irq->triggering,
  384. extended_irq->polarity,
  385. extended_irq->sharable);
  386. }
  387. /*
  388. * The IRQ encoder puts a single interrupt in each
  389. * descriptor, so if a _CRS descriptor has more than
  390. * one interrupt, we won't be able to re-encode it.
  391. */
  392. if (pnp_can_write(dev) &&
  393. extended_irq->interrupt_count > 1) {
  394. dev_warn(&dev->dev, "multiple interrupts in "
  395. "_CRS descriptor; configuration can't "
  396. "be changed\n");
  397. dev->capabilities &= ~PNP_WRITE;
  398. }
  399. }
  400. break;
  401. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  402. break;
  403. default:
  404. dev_warn(&dev->dev, "unknown resource type %d in _CRS\n",
  405. res->type);
  406. return AE_ERROR;
  407. }
  408. return AE_OK;
  409. }
  410. int pnpacpi_parse_allocated_resource(struct pnp_dev *dev)
  411. {
  412. struct acpi_device *acpi_dev = dev->data;
  413. acpi_handle handle = acpi_dev->handle;
  414. acpi_status status;
  415. pnp_dbg(&dev->dev, "parse allocated resources\n");
  416. pnp_init_resources(dev);
  417. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  418. pnpacpi_allocated_resource, dev);
  419. if (ACPI_FAILURE(status)) {
  420. if (status != AE_NOT_FOUND)
  421. dev_err(&dev->dev, "can't evaluate _CRS: %d", status);
  422. return -EPERM;
  423. }
  424. return 0;
  425. }
  426. static __init void pnpacpi_parse_dma_option(struct pnp_dev *dev,
  427. unsigned int option_flags,
  428. struct acpi_resource_dma *p)
  429. {
  430. int i;
  431. unsigned char map = 0, flags;
  432. if (p->channel_count == 0)
  433. return;
  434. for (i = 0; i < p->channel_count; i++)
  435. map |= 1 << p->channels[i];
  436. flags = dma_flags(dev, p->type, p->bus_master, p->transfer);
  437. pnp_register_dma_resource(dev, option_flags, map, flags);
  438. }
  439. static __init void pnpacpi_parse_irq_option(struct pnp_dev *dev,
  440. unsigned int option_flags,
  441. struct acpi_resource_irq *p)
  442. {
  443. int i;
  444. pnp_irq_mask_t map;
  445. unsigned char flags;
  446. if (p->interrupt_count == 0)
  447. return;
  448. bitmap_zero(map.bits, PNP_IRQ_NR);
  449. for (i = 0; i < p->interrupt_count; i++)
  450. if (p->interrupts[i])
  451. __set_bit(p->interrupts[i], map.bits);
  452. flags = irq_flags(p->triggering, p->polarity, p->sharable);
  453. pnp_register_irq_resource(dev, option_flags, &map, flags);
  454. }
  455. static __init void pnpacpi_parse_ext_irq_option(struct pnp_dev *dev,
  456. unsigned int option_flags,
  457. struct acpi_resource_extended_irq *p)
  458. {
  459. int i;
  460. pnp_irq_mask_t map;
  461. unsigned char flags;
  462. if (p->interrupt_count == 0)
  463. return;
  464. bitmap_zero(map.bits, PNP_IRQ_NR);
  465. for (i = 0; i < p->interrupt_count; i++) {
  466. if (p->interrupts[i]) {
  467. if (p->interrupts[i] < PNP_IRQ_NR)
  468. __set_bit(p->interrupts[i], map.bits);
  469. else
  470. dev_err(&dev->dev, "ignoring IRQ %d option "
  471. "(too large for %d entry bitmap)\n",
  472. p->interrupts[i], PNP_IRQ_NR);
  473. }
  474. }
  475. flags = irq_flags(p->triggering, p->polarity, p->sharable);
  476. pnp_register_irq_resource(dev, option_flags, &map, flags);
  477. }
  478. static __init void pnpacpi_parse_port_option(struct pnp_dev *dev,
  479. unsigned int option_flags,
  480. struct acpi_resource_io *io)
  481. {
  482. unsigned char flags = 0;
  483. if (io->address_length == 0)
  484. return;
  485. if (io->io_decode == ACPI_DECODE_16)
  486. flags = IORESOURCE_IO_16BIT_ADDR;
  487. pnp_register_port_resource(dev, option_flags, io->minimum, io->maximum,
  488. io->alignment, io->address_length, flags);
  489. }
  490. static __init void pnpacpi_parse_fixed_port_option(struct pnp_dev *dev,
  491. unsigned int option_flags,
  492. struct acpi_resource_fixed_io *io)
  493. {
  494. if (io->address_length == 0)
  495. return;
  496. pnp_register_port_resource(dev, option_flags, io->address, io->address,
  497. 0, io->address_length, IORESOURCE_IO_FIXED);
  498. }
  499. static __init void pnpacpi_parse_mem24_option(struct pnp_dev *dev,
  500. unsigned int option_flags,
  501. struct acpi_resource_memory24 *p)
  502. {
  503. unsigned char flags = 0;
  504. if (p->address_length == 0)
  505. return;
  506. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  507. flags = IORESOURCE_MEM_WRITEABLE;
  508. pnp_register_mem_resource(dev, option_flags, p->minimum, p->maximum,
  509. p->alignment, p->address_length, flags);
  510. }
  511. static __init void pnpacpi_parse_mem32_option(struct pnp_dev *dev,
  512. unsigned int option_flags,
  513. struct acpi_resource_memory32 *p)
  514. {
  515. unsigned char flags = 0;
  516. if (p->address_length == 0)
  517. return;
  518. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  519. flags = IORESOURCE_MEM_WRITEABLE;
  520. pnp_register_mem_resource(dev, option_flags, p->minimum, p->maximum,
  521. p->alignment, p->address_length, flags);
  522. }
  523. static __init void pnpacpi_parse_fixed_mem32_option(struct pnp_dev *dev,
  524. unsigned int option_flags,
  525. struct acpi_resource_fixed_memory32 *p)
  526. {
  527. unsigned char flags = 0;
  528. if (p->address_length == 0)
  529. return;
  530. if (p->write_protect == ACPI_READ_WRITE_MEMORY)
  531. flags = IORESOURCE_MEM_WRITEABLE;
  532. pnp_register_mem_resource(dev, option_flags, p->address, p->address,
  533. 0, p->address_length, flags);
  534. }
  535. static __init void pnpacpi_parse_address_option(struct pnp_dev *dev,
  536. unsigned int option_flags,
  537. struct acpi_resource *r)
  538. {
  539. struct acpi_resource_address64 addr, *p = &addr;
  540. acpi_status status;
  541. unsigned char flags = 0;
  542. status = acpi_resource_to_address64(r, p);
  543. if (ACPI_FAILURE(status)) {
  544. dev_warn(&dev->dev, "can't convert resource type %d\n",
  545. r->type);
  546. return;
  547. }
  548. if (p->address_length == 0)
  549. return;
  550. if (p->resource_type == ACPI_MEMORY_RANGE) {
  551. if (p->info.mem.write_protect == ACPI_READ_WRITE_MEMORY)
  552. flags = IORESOURCE_MEM_WRITEABLE;
  553. pnp_register_mem_resource(dev, option_flags, p->minimum,
  554. p->minimum, 0, p->address_length,
  555. flags);
  556. } else if (p->resource_type == ACPI_IO_RANGE)
  557. pnp_register_port_resource(dev, option_flags, p->minimum,
  558. p->minimum, 0, p->address_length,
  559. IORESOURCE_IO_FIXED);
  560. }
  561. static __init void pnpacpi_parse_ext_address_option(struct pnp_dev *dev,
  562. unsigned int option_flags,
  563. struct acpi_resource *r)
  564. {
  565. struct acpi_resource_extended_address64 *p = &r->data.ext_address64;
  566. unsigned char flags = 0;
  567. if (p->address_length == 0)
  568. return;
  569. if (p->resource_type == ACPI_MEMORY_RANGE) {
  570. if (p->info.mem.write_protect == ACPI_READ_WRITE_MEMORY)
  571. flags = IORESOURCE_MEM_WRITEABLE;
  572. pnp_register_mem_resource(dev, option_flags, p->minimum,
  573. p->minimum, 0, p->address_length,
  574. flags);
  575. } else if (p->resource_type == ACPI_IO_RANGE)
  576. pnp_register_port_resource(dev, option_flags, p->minimum,
  577. p->minimum, 0, p->address_length,
  578. IORESOURCE_IO_FIXED);
  579. }
  580. struct acpipnp_parse_option_s {
  581. struct pnp_dev *dev;
  582. unsigned int option_flags;
  583. };
  584. static __init acpi_status pnpacpi_option_resource(struct acpi_resource *res,
  585. void *data)
  586. {
  587. int priority;
  588. struct acpipnp_parse_option_s *parse_data = data;
  589. struct pnp_dev *dev = parse_data->dev;
  590. unsigned int option_flags = parse_data->option_flags;
  591. switch (res->type) {
  592. case ACPI_RESOURCE_TYPE_IRQ:
  593. pnpacpi_parse_irq_option(dev, option_flags, &res->data.irq);
  594. break;
  595. case ACPI_RESOURCE_TYPE_DMA:
  596. pnpacpi_parse_dma_option(dev, option_flags, &res->data.dma);
  597. break;
  598. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  599. switch (res->data.start_dpf.compatibility_priority) {
  600. case ACPI_GOOD_CONFIGURATION:
  601. priority = PNP_RES_PRIORITY_PREFERRED;
  602. break;
  603. case ACPI_ACCEPTABLE_CONFIGURATION:
  604. priority = PNP_RES_PRIORITY_ACCEPTABLE;
  605. break;
  606. case ACPI_SUB_OPTIMAL_CONFIGURATION:
  607. priority = PNP_RES_PRIORITY_FUNCTIONAL;
  608. break;
  609. default:
  610. priority = PNP_RES_PRIORITY_INVALID;
  611. break;
  612. }
  613. parse_data->option_flags = pnp_new_dependent_set(dev, priority);
  614. break;
  615. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  616. parse_data->option_flags = 0;
  617. break;
  618. case ACPI_RESOURCE_TYPE_IO:
  619. pnpacpi_parse_port_option(dev, option_flags, &res->data.io);
  620. break;
  621. case ACPI_RESOURCE_TYPE_FIXED_IO:
  622. pnpacpi_parse_fixed_port_option(dev, option_flags,
  623. &res->data.fixed_io);
  624. break;
  625. case ACPI_RESOURCE_TYPE_VENDOR:
  626. case ACPI_RESOURCE_TYPE_END_TAG:
  627. break;
  628. case ACPI_RESOURCE_TYPE_MEMORY24:
  629. pnpacpi_parse_mem24_option(dev, option_flags,
  630. &res->data.memory24);
  631. break;
  632. case ACPI_RESOURCE_TYPE_MEMORY32:
  633. pnpacpi_parse_mem32_option(dev, option_flags,
  634. &res->data.memory32);
  635. break;
  636. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  637. pnpacpi_parse_fixed_mem32_option(dev, option_flags,
  638. &res->data.fixed_memory32);
  639. break;
  640. case ACPI_RESOURCE_TYPE_ADDRESS16:
  641. case ACPI_RESOURCE_TYPE_ADDRESS32:
  642. case ACPI_RESOURCE_TYPE_ADDRESS64:
  643. pnpacpi_parse_address_option(dev, option_flags, res);
  644. break;
  645. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  646. pnpacpi_parse_ext_address_option(dev, option_flags, res);
  647. break;
  648. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  649. pnpacpi_parse_ext_irq_option(dev, option_flags,
  650. &res->data.extended_irq);
  651. break;
  652. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  653. break;
  654. default:
  655. dev_warn(&dev->dev, "unknown resource type %d in _PRS\n",
  656. res->type);
  657. return AE_ERROR;
  658. }
  659. return AE_OK;
  660. }
  661. int __init pnpacpi_parse_resource_option_data(struct pnp_dev *dev)
  662. {
  663. struct acpi_device *acpi_dev = dev->data;
  664. acpi_handle handle = acpi_dev->handle;
  665. acpi_status status;
  666. struct acpipnp_parse_option_s parse_data;
  667. pnp_dbg(&dev->dev, "parse resource options\n");
  668. parse_data.dev = dev;
  669. parse_data.option_flags = 0;
  670. status = acpi_walk_resources(handle, METHOD_NAME__PRS,
  671. pnpacpi_option_resource, &parse_data);
  672. if (ACPI_FAILURE(status)) {
  673. if (status != AE_NOT_FOUND)
  674. dev_err(&dev->dev, "can't evaluate _PRS: %d", status);
  675. return -EPERM;
  676. }
  677. return 0;
  678. }
  679. static int pnpacpi_supported_resource(struct acpi_resource *res)
  680. {
  681. switch (res->type) {
  682. case ACPI_RESOURCE_TYPE_IRQ:
  683. case ACPI_RESOURCE_TYPE_DMA:
  684. case ACPI_RESOURCE_TYPE_IO:
  685. case ACPI_RESOURCE_TYPE_FIXED_IO:
  686. case ACPI_RESOURCE_TYPE_MEMORY24:
  687. case ACPI_RESOURCE_TYPE_MEMORY32:
  688. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  689. case ACPI_RESOURCE_TYPE_ADDRESS16:
  690. case ACPI_RESOURCE_TYPE_ADDRESS32:
  691. case ACPI_RESOURCE_TYPE_ADDRESS64:
  692. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  693. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  694. return 1;
  695. }
  696. return 0;
  697. }
  698. /*
  699. * Set resource
  700. */
  701. static acpi_status pnpacpi_count_resources(struct acpi_resource *res,
  702. void *data)
  703. {
  704. int *res_cnt = data;
  705. if (pnpacpi_supported_resource(res))
  706. (*res_cnt)++;
  707. return AE_OK;
  708. }
  709. static acpi_status pnpacpi_type_resources(struct acpi_resource *res, void *data)
  710. {
  711. struct acpi_resource **resource = data;
  712. if (pnpacpi_supported_resource(res)) {
  713. (*resource)->type = res->type;
  714. (*resource)->length = sizeof(struct acpi_resource);
  715. if (res->type == ACPI_RESOURCE_TYPE_IRQ)
  716. (*resource)->data.irq.descriptor_length =
  717. res->data.irq.descriptor_length;
  718. (*resource)++;
  719. }
  720. return AE_OK;
  721. }
  722. int pnpacpi_build_resource_template(struct pnp_dev *dev,
  723. struct acpi_buffer *buffer)
  724. {
  725. struct acpi_device *acpi_dev = dev->data;
  726. acpi_handle handle = acpi_dev->handle;
  727. struct acpi_resource *resource;
  728. int res_cnt = 0;
  729. acpi_status status;
  730. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  731. pnpacpi_count_resources, &res_cnt);
  732. if (ACPI_FAILURE(status)) {
  733. dev_err(&dev->dev, "can't evaluate _CRS: %d\n", status);
  734. return -EINVAL;
  735. }
  736. if (!res_cnt)
  737. return -EINVAL;
  738. buffer->length = sizeof(struct acpi_resource) * (res_cnt + 1) + 1;
  739. buffer->pointer = kzalloc(buffer->length - 1, GFP_KERNEL);
  740. if (!buffer->pointer)
  741. return -ENOMEM;
  742. resource = (struct acpi_resource *)buffer->pointer;
  743. status = acpi_walk_resources(handle, METHOD_NAME__CRS,
  744. pnpacpi_type_resources, &resource);
  745. if (ACPI_FAILURE(status)) {
  746. kfree(buffer->pointer);
  747. dev_err(&dev->dev, "can't evaluate _CRS: %d\n", status);
  748. return -EINVAL;
  749. }
  750. /* resource will pointer the end resource now */
  751. resource->type = ACPI_RESOURCE_TYPE_END_TAG;
  752. return 0;
  753. }
  754. static void pnpacpi_encode_irq(struct pnp_dev *dev,
  755. struct acpi_resource *resource,
  756. struct resource *p)
  757. {
  758. struct acpi_resource_irq *irq = &resource->data.irq;
  759. int triggering, polarity, shareable;
  760. if (!pnp_resource_enabled(p)) {
  761. irq->interrupt_count = 0;
  762. pnp_dbg(&dev->dev, " encode irq (%s)\n",
  763. p ? "disabled" : "missing");
  764. return;
  765. }
  766. decode_irq_flags(dev, p->flags, &triggering, &polarity, &shareable);
  767. irq->triggering = triggering;
  768. irq->polarity = polarity;
  769. irq->sharable = shareable;
  770. irq->interrupt_count = 1;
  771. irq->interrupts[0] = p->start;
  772. pnp_dbg(&dev->dev, " encode irq %d %s %s %s (%d-byte descriptor)\n",
  773. (int) p->start,
  774. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  775. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  776. irq->sharable == ACPI_SHARED ? "shared" : "exclusive",
  777. irq->descriptor_length);
  778. }
  779. static void pnpacpi_encode_ext_irq(struct pnp_dev *dev,
  780. struct acpi_resource *resource,
  781. struct resource *p)
  782. {
  783. struct acpi_resource_extended_irq *extended_irq = &resource->data.extended_irq;
  784. int triggering, polarity, shareable;
  785. if (!pnp_resource_enabled(p)) {
  786. extended_irq->interrupt_count = 0;
  787. pnp_dbg(&dev->dev, " encode extended irq (%s)\n",
  788. p ? "disabled" : "missing");
  789. return;
  790. }
  791. decode_irq_flags(dev, p->flags, &triggering, &polarity, &shareable);
  792. extended_irq->producer_consumer = ACPI_CONSUMER;
  793. extended_irq->triggering = triggering;
  794. extended_irq->polarity = polarity;
  795. extended_irq->sharable = shareable;
  796. extended_irq->interrupt_count = 1;
  797. extended_irq->interrupts[0] = p->start;
  798. pnp_dbg(&dev->dev, " encode irq %d %s %s %s\n", (int) p->start,
  799. triggering == ACPI_LEVEL_SENSITIVE ? "level" : "edge",
  800. polarity == ACPI_ACTIVE_LOW ? "low" : "high",
  801. extended_irq->sharable == ACPI_SHARED ? "shared" : "exclusive");
  802. }
  803. static void pnpacpi_encode_dma(struct pnp_dev *dev,
  804. struct acpi_resource *resource,
  805. struct resource *p)
  806. {
  807. struct acpi_resource_dma *dma = &resource->data.dma;
  808. if (!pnp_resource_enabled(p)) {
  809. dma->channel_count = 0;
  810. pnp_dbg(&dev->dev, " encode dma (%s)\n",
  811. p ? "disabled" : "missing");
  812. return;
  813. }
  814. /* Note: pnp_assign_dma will copy pnp_dma->flags into p->flags */
  815. switch (p->flags & IORESOURCE_DMA_SPEED_MASK) {
  816. case IORESOURCE_DMA_TYPEA:
  817. dma->type = ACPI_TYPE_A;
  818. break;
  819. case IORESOURCE_DMA_TYPEB:
  820. dma->type = ACPI_TYPE_B;
  821. break;
  822. case IORESOURCE_DMA_TYPEF:
  823. dma->type = ACPI_TYPE_F;
  824. break;
  825. default:
  826. dma->type = ACPI_COMPATIBILITY;
  827. }
  828. switch (p->flags & IORESOURCE_DMA_TYPE_MASK) {
  829. case IORESOURCE_DMA_8BIT:
  830. dma->transfer = ACPI_TRANSFER_8;
  831. break;
  832. case IORESOURCE_DMA_8AND16BIT:
  833. dma->transfer = ACPI_TRANSFER_8_16;
  834. break;
  835. default:
  836. dma->transfer = ACPI_TRANSFER_16;
  837. }
  838. dma->bus_master = !!(p->flags & IORESOURCE_DMA_MASTER);
  839. dma->channel_count = 1;
  840. dma->channels[0] = p->start;
  841. pnp_dbg(&dev->dev, " encode dma %d "
  842. "type %#x transfer %#x master %d\n",
  843. (int) p->start, dma->type, dma->transfer, dma->bus_master);
  844. }
  845. static void pnpacpi_encode_io(struct pnp_dev *dev,
  846. struct acpi_resource *resource,
  847. struct resource *p)
  848. {
  849. struct acpi_resource_io *io = &resource->data.io;
  850. if (pnp_resource_enabled(p)) {
  851. /* Note: pnp_assign_port copies pnp_port->flags into p->flags */
  852. io->io_decode = (p->flags & IORESOURCE_IO_16BIT_ADDR) ?
  853. ACPI_DECODE_16 : ACPI_DECODE_10;
  854. io->minimum = p->start;
  855. io->maximum = p->end;
  856. io->alignment = 0; /* Correct? */
  857. io->address_length = p->end - p->start + 1;
  858. } else {
  859. io->minimum = 0;
  860. io->address_length = 0;
  861. }
  862. pnp_dbg(&dev->dev, " encode io %#x-%#x decode %#x\n", io->minimum,
  863. io->minimum + io->address_length - 1, io->io_decode);
  864. }
  865. static void pnpacpi_encode_fixed_io(struct pnp_dev *dev,
  866. struct acpi_resource *resource,
  867. struct resource *p)
  868. {
  869. struct acpi_resource_fixed_io *fixed_io = &resource->data.fixed_io;
  870. if (pnp_resource_enabled(p)) {
  871. fixed_io->address = p->start;
  872. fixed_io->address_length = p->end - p->start + 1;
  873. } else {
  874. fixed_io->address = 0;
  875. fixed_io->address_length = 0;
  876. }
  877. pnp_dbg(&dev->dev, " encode fixed_io %#x-%#x\n", fixed_io->address,
  878. fixed_io->address + fixed_io->address_length - 1);
  879. }
  880. static void pnpacpi_encode_mem24(struct pnp_dev *dev,
  881. struct acpi_resource *resource,
  882. struct resource *p)
  883. {
  884. struct acpi_resource_memory24 *memory24 = &resource->data.memory24;
  885. if (pnp_resource_enabled(p)) {
  886. /* Note: pnp_assign_mem copies pnp_mem->flags into p->flags */
  887. memory24->write_protect = p->flags & IORESOURCE_MEM_WRITEABLE ?
  888. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  889. memory24->minimum = p->start;
  890. memory24->maximum = p->end;
  891. memory24->alignment = 0;
  892. memory24->address_length = p->end - p->start + 1;
  893. } else {
  894. memory24->minimum = 0;
  895. memory24->address_length = 0;
  896. }
  897. pnp_dbg(&dev->dev, " encode mem24 %#x-%#x write_protect %#x\n",
  898. memory24->minimum,
  899. memory24->minimum + memory24->address_length - 1,
  900. memory24->write_protect);
  901. }
  902. static void pnpacpi_encode_mem32(struct pnp_dev *dev,
  903. struct acpi_resource *resource,
  904. struct resource *p)
  905. {
  906. struct acpi_resource_memory32 *memory32 = &resource->data.memory32;
  907. if (pnp_resource_enabled(p)) {
  908. memory32->write_protect = p->flags & IORESOURCE_MEM_WRITEABLE ?
  909. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  910. memory32->minimum = p->start;
  911. memory32->maximum = p->end;
  912. memory32->alignment = 0;
  913. memory32->address_length = p->end - p->start + 1;
  914. } else {
  915. memory32->minimum = 0;
  916. memory32->alignment = 0;
  917. }
  918. pnp_dbg(&dev->dev, " encode mem32 %#x-%#x write_protect %#x\n",
  919. memory32->minimum,
  920. memory32->minimum + memory32->address_length - 1,
  921. memory32->write_protect);
  922. }
  923. static void pnpacpi_encode_fixed_mem32(struct pnp_dev *dev,
  924. struct acpi_resource *resource,
  925. struct resource *p)
  926. {
  927. struct acpi_resource_fixed_memory32 *fixed_memory32 = &resource->data.fixed_memory32;
  928. if (pnp_resource_enabled(p)) {
  929. fixed_memory32->write_protect =
  930. p->flags & IORESOURCE_MEM_WRITEABLE ?
  931. ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY;
  932. fixed_memory32->address = p->start;
  933. fixed_memory32->address_length = p->end - p->start + 1;
  934. } else {
  935. fixed_memory32->address = 0;
  936. fixed_memory32->address_length = 0;
  937. }
  938. pnp_dbg(&dev->dev, " encode fixed_mem32 %#x-%#x write_protect %#x\n",
  939. fixed_memory32->address,
  940. fixed_memory32->address + fixed_memory32->address_length - 1,
  941. fixed_memory32->write_protect);
  942. }
  943. int pnpacpi_encode_resources(struct pnp_dev *dev, struct acpi_buffer *buffer)
  944. {
  945. int i = 0;
  946. /* pnpacpi_build_resource_template allocates extra mem */
  947. int res_cnt = (buffer->length - 1) / sizeof(struct acpi_resource) - 1;
  948. struct acpi_resource *resource = buffer->pointer;
  949. int port = 0, irq = 0, dma = 0, mem = 0;
  950. pnp_dbg(&dev->dev, "encode %d resources\n", res_cnt);
  951. while (i < res_cnt) {
  952. switch (resource->type) {
  953. case ACPI_RESOURCE_TYPE_IRQ:
  954. pnpacpi_encode_irq(dev, resource,
  955. pnp_get_resource(dev, IORESOURCE_IRQ, irq));
  956. irq++;
  957. break;
  958. case ACPI_RESOURCE_TYPE_DMA:
  959. pnpacpi_encode_dma(dev, resource,
  960. pnp_get_resource(dev, IORESOURCE_DMA, dma));
  961. dma++;
  962. break;
  963. case ACPI_RESOURCE_TYPE_IO:
  964. pnpacpi_encode_io(dev, resource,
  965. pnp_get_resource(dev, IORESOURCE_IO, port));
  966. port++;
  967. break;
  968. case ACPI_RESOURCE_TYPE_FIXED_IO:
  969. pnpacpi_encode_fixed_io(dev, resource,
  970. pnp_get_resource(dev, IORESOURCE_IO, port));
  971. port++;
  972. break;
  973. case ACPI_RESOURCE_TYPE_MEMORY24:
  974. pnpacpi_encode_mem24(dev, resource,
  975. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  976. mem++;
  977. break;
  978. case ACPI_RESOURCE_TYPE_MEMORY32:
  979. pnpacpi_encode_mem32(dev, resource,
  980. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  981. mem++;
  982. break;
  983. case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
  984. pnpacpi_encode_fixed_mem32(dev, resource,
  985. pnp_get_resource(dev, IORESOURCE_MEM, mem));
  986. mem++;
  987. break;
  988. case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
  989. pnpacpi_encode_ext_irq(dev, resource,
  990. pnp_get_resource(dev, IORESOURCE_IRQ, irq));
  991. irq++;
  992. break;
  993. case ACPI_RESOURCE_TYPE_START_DEPENDENT:
  994. case ACPI_RESOURCE_TYPE_END_DEPENDENT:
  995. case ACPI_RESOURCE_TYPE_VENDOR:
  996. case ACPI_RESOURCE_TYPE_END_TAG:
  997. case ACPI_RESOURCE_TYPE_ADDRESS16:
  998. case ACPI_RESOURCE_TYPE_ADDRESS32:
  999. case ACPI_RESOURCE_TYPE_ADDRESS64:
  1000. case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64:
  1001. case ACPI_RESOURCE_TYPE_GENERIC_REGISTER:
  1002. default: /* other type */
  1003. dev_warn(&dev->dev, "can't encode unknown resource "
  1004. "type %d\n", resource->type);
  1005. return -EINVAL;
  1006. }
  1007. resource++;
  1008. i++;
  1009. }
  1010. return 0;
  1011. }