diff options
author | Witold Szczeponik <Witold.Szczeponik@gmx.net> | 2012-12-14 19:00:14 -0500 |
---|---|---|
committer | Rafael J. Wysocki <rafael.j.wysocki@intel.com> | 2013-01-03 07:10:52 -0500 |
commit | c9377667e6cdf4ac910b0932868275eb0dbfcfeb (patch) | |
tree | 189ac5c14e40bad116528c110d6c0251cbcb7168 | |
parent | d1c3ed669a2d452cacfb48c2d171a1f364dae2ed (diff) |
PNP: Simplify setting of resources
This patch factors out the setting of PNP resources into one function which is
then reused for all PNP resource types. This makes the code more concise and
avoids duplication. The parameters "type" and "flags" are not used at the
moment but may be used by follow-up patches. Placeholders for these patches
can be found in the comment lines that contain the "TBD" marker.
As the code does not make any changes to the ABI, no regressions are expected.
NB: While at it, support for bus type resources is added.
Signed-off-by: Witold Szczeponik <Witold.Szczeponik@gmx.net>
Reviewed-by: Bjorn Helgaas <bhelgaas@google.com>
Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
-rw-r--r-- | drivers/pnp/interface.c | 105 |
1 files changed, 68 insertions, 37 deletions
diff --git a/drivers/pnp/interface.c b/drivers/pnp/interface.c index cfaf5b73540..0c201317284 100644 --- a/drivers/pnp/interface.c +++ b/drivers/pnp/interface.c | |||
@@ -298,6 +298,39 @@ static ssize_t pnp_show_current_resources(struct device *dmdev, | |||
298 | return ret; | 298 | return ret; |
299 | } | 299 | } |
300 | 300 | ||
301 | static char *pnp_get_resource_value(char *buf, | ||
302 | unsigned long type, | ||
303 | resource_size_t *start, | ||
304 | resource_size_t *end, | ||
305 | unsigned long *flags) | ||
306 | { | ||
307 | if (start) | ||
308 | *start = 0; | ||
309 | if (end) | ||
310 | *end = 0; | ||
311 | if (flags) | ||
312 | *flags = 0; | ||
313 | |||
314 | /* TBD: allow for disabled resources */ | ||
315 | |||
316 | buf = skip_spaces(buf); | ||
317 | if (start) { | ||
318 | *start = simple_strtoull(buf, &buf, 0); | ||
319 | if (end) { | ||
320 | buf = skip_spaces(buf); | ||
321 | if (*buf == '-') { | ||
322 | buf = skip_spaces(buf + 1); | ||
323 | *end = simple_strtoull(buf, &buf, 0); | ||
324 | } else | ||
325 | *end = *start; | ||
326 | } | ||
327 | } | ||
328 | |||
329 | /* TBD: allow for additional flags, e.g., IORESOURCE_WINDOW */ | ||
330 | |||
331 | return buf; | ||
332 | } | ||
333 | |||
301 | static ssize_t pnp_set_current_resources(struct device *dmdev, | 334 | static ssize_t pnp_set_current_resources(struct device *dmdev, |
302 | struct device_attribute *attr, | 335 | struct device_attribute *attr, |
303 | const char *ubuf, size_t count) | 336 | const char *ubuf, size_t count) |
@@ -305,7 +338,6 @@ static ssize_t pnp_set_current_resources(struct device *dmdev, | |||
305 | struct pnp_dev *dev = to_pnp_dev(dmdev); | 338 | struct pnp_dev *dev = to_pnp_dev(dmdev); |
306 | char *buf = (void *)ubuf; | 339 | char *buf = (void *)ubuf; |
307 | int retval = 0; | 340 | int retval = 0; |
308 | resource_size_t start, end; | ||
309 | 341 | ||
310 | if (dev->status & PNP_ATTACHED) { | 342 | if (dev->status & PNP_ATTACHED) { |
311 | retval = -EBUSY; | 343 | retval = -EBUSY; |
@@ -349,6 +381,10 @@ static ssize_t pnp_set_current_resources(struct device *dmdev, | |||
349 | goto done; | 381 | goto done; |
350 | } | 382 | } |
351 | if (!strnicmp(buf, "set", 3)) { | 383 | if (!strnicmp(buf, "set", 3)) { |
384 | resource_size_t start; | ||
385 | resource_size_t end; | ||
386 | unsigned long flags; | ||
387 | |||
352 | if (dev->active) | 388 | if (dev->active) |
353 | goto done; | 389 | goto done; |
354 | buf += 3; | 390 | buf += 3; |
@@ -357,42 +393,37 @@ static ssize_t pnp_set_current_resources(struct device *dmdev, | |||
357 | while (1) { | 393 | while (1) { |
358 | buf = skip_spaces(buf); | 394 | buf = skip_spaces(buf); |
359 | if (!strnicmp(buf, "io", 2)) { | 395 | if (!strnicmp(buf, "io", 2)) { |
360 | buf = skip_spaces(buf + 2); | 396 | buf = pnp_get_resource_value(buf + 2, |
361 | start = simple_strtoul(buf, &buf, 0); | 397 | IORESOURCE_IO, |
362 | buf = skip_spaces(buf); | 398 | &start, &end, |
363 | if (*buf == '-') { | 399 | &flags); |
364 | buf = skip_spaces(buf + 1); | 400 | pnp_add_io_resource(dev, start, end, flags); |
365 | end = simple_strtoul(buf, &buf, 0); | 401 | } else if (!strnicmp(buf, "mem", 3)) { |
366 | } else | 402 | buf = pnp_get_resource_value(buf + 3, |
367 | end = start; | 403 | IORESOURCE_MEM, |
368 | pnp_add_io_resource(dev, start, end, 0); | 404 | &start, &end, |
369 | continue; | 405 | &flags); |
370 | } | 406 | pnp_add_mem_resource(dev, start, end, flags); |
371 | if (!strnicmp(buf, "mem", 3)) { | 407 | } else if (!strnicmp(buf, "irq", 3)) { |
372 | buf = skip_spaces(buf + 3); | 408 | buf = pnp_get_resource_value(buf + 3, |
373 | start = simple_strtoul(buf, &buf, 0); | 409 | IORESOURCE_IRQ, |
374 | buf = skip_spaces(buf); | 410 | &start, NULL, |
375 | if (*buf == '-') { | 411 | &flags); |
376 | buf = skip_spaces(buf + 1); | 412 | pnp_add_irq_resource(dev, start, flags); |
377 | end = simple_strtoul(buf, &buf, 0); | 413 | } else if (!strnicmp(buf, "dma", 3)) { |
378 | } else | 414 | buf = pnp_get_resource_value(buf + 3, |
379 | end = start; | 415 | IORESOURCE_DMA, |
380 | pnp_add_mem_resource(dev, start, end, 0); | 416 | &start, NULL, |
381 | continue; | 417 | &flags); |
382 | } | 418 | pnp_add_dma_resource(dev, start, flags); |
383 | if (!strnicmp(buf, "irq", 3)) { | 419 | } else if (!strnicmp(buf, "bus", 3)) { |
384 | buf = skip_spaces(buf + 3); | 420 | buf = pnp_get_resource_value(buf + 3, |
385 | start = simple_strtoul(buf, &buf, 0); | 421 | IORESOURCE_BUS, |
386 | pnp_add_irq_resource(dev, start, 0); | 422 | &start, &end, |
387 | continue; | 423 | NULL); |
388 | } | 424 | pnp_add_bus_resource(dev, start, end); |
389 | if (!strnicmp(buf, "dma", 3)) { | 425 | } else |
390 | buf = skip_spaces(buf + 3); | 426 | break; |
391 | start = simple_strtoul(buf, &buf, 0); | ||
392 | pnp_add_dma_resource(dev, start, 0); | ||
393 | continue; | ||
394 | } | ||
395 | break; | ||
396 | } | 427 | } |
397 | mutex_unlock(&pnp_res_mutex); | 428 | mutex_unlock(&pnp_res_mutex); |
398 | goto done; | 429 | goto done; |