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 | ||