diff options
Diffstat (limited to 'drivers/clocksource/sh_cmt.c')
| -rw-r--r-- | drivers/clocksource/sh_cmt.c | 32 |
1 files changed, 19 insertions, 13 deletions
diff --git a/drivers/clocksource/sh_cmt.c b/drivers/clocksource/sh_cmt.c index 6b3e0c2f33e2..6fe4f7701188 100644 --- a/drivers/clocksource/sh_cmt.c +++ b/drivers/clocksource/sh_cmt.c | |||
| @@ -603,18 +603,13 @@ static int sh_cmt_setup(struct sh_cmt_priv *p, struct platform_device *pdev) | |||
| 603 | p->irqaction.handler = sh_cmt_interrupt; | 603 | p->irqaction.handler = sh_cmt_interrupt; |
| 604 | p->irqaction.dev_id = p; | 604 | p->irqaction.dev_id = p; |
| 605 | p->irqaction.flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL; | 605 | p->irqaction.flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL; |
| 606 | ret = setup_irq(irq, &p->irqaction); | ||
| 607 | if (ret) { | ||
| 608 | pr_err("sh_cmt: failed to request irq %d\n", irq); | ||
| 609 | goto err1; | ||
| 610 | } | ||
| 611 | 606 | ||
| 612 | /* get hold of clock */ | 607 | /* get hold of clock */ |
| 613 | p->clk = clk_get(&p->pdev->dev, cfg->clk); | 608 | p->clk = clk_get(&p->pdev->dev, cfg->clk); |
| 614 | if (IS_ERR(p->clk)) { | 609 | if (IS_ERR(p->clk)) { |
| 615 | pr_err("sh_cmt: cannot get clock \"%s\"\n", cfg->clk); | 610 | pr_err("sh_cmt: cannot get clock \"%s\"\n", cfg->clk); |
| 616 | ret = PTR_ERR(p->clk); | 611 | ret = PTR_ERR(p->clk); |
| 617 | goto err2; | 612 | goto err1; |
| 618 | } | 613 | } |
| 619 | 614 | ||
| 620 | if (resource_size(res) == 6) { | 615 | if (resource_size(res) == 6) { |
| @@ -627,14 +622,25 @@ static int sh_cmt_setup(struct sh_cmt_priv *p, struct platform_device *pdev) | |||
| 627 | p->clear_bits = ~0xc000; | 622 | p->clear_bits = ~0xc000; |
| 628 | } | 623 | } |
| 629 | 624 | ||
| 630 | return sh_cmt_register(p, cfg->name, | 625 | ret = sh_cmt_register(p, cfg->name, |
| 631 | cfg->clockevent_rating, | 626 | cfg->clockevent_rating, |
| 632 | cfg->clocksource_rating); | 627 | cfg->clocksource_rating); |
| 633 | err2: | 628 | if (ret) { |
| 634 | remove_irq(irq, &p->irqaction); | 629 | pr_err("sh_cmt: registration failed\n"); |
| 635 | err1: | 630 | goto err1; |
| 631 | } | ||
| 632 | |||
| 633 | ret = setup_irq(irq, &p->irqaction); | ||
| 634 | if (ret) { | ||
| 635 | pr_err("sh_cmt: failed to request irq %d\n", irq); | ||
| 636 | goto err1; | ||
| 637 | } | ||
| 638 | |||
| 639 | return 0; | ||
| 640 | |||
| 641 | err1: | ||
| 636 | iounmap(p->mapbase); | 642 | iounmap(p->mapbase); |
| 637 | err0: | 643 | err0: |
| 638 | return ret; | 644 | return ret; |
| 639 | } | 645 | } |
| 640 | 646 | ||
