diff options
| -rw-r--r-- | drivers/clocksource/sh_cmt.c | 32 | ||||
| -rw-r--r-- | drivers/clocksource/sh_mtu2.c | 6 | ||||
| -rw-r--r-- | drivers/clocksource/sh_tmu.c | 6 |
3 files changed, 25 insertions, 19 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 | ||
diff --git a/drivers/clocksource/sh_mtu2.c b/drivers/clocksource/sh_mtu2.c index 973e714d6051..4c8a759e60cd 100644 --- a/drivers/clocksource/sh_mtu2.c +++ b/drivers/clocksource/sh_mtu2.c | |||
| @@ -221,15 +221,15 @@ static void sh_mtu2_register_clockevent(struct sh_mtu2_priv *p, | |||
| 221 | ced->cpumask = cpumask_of(0); | 221 | ced->cpumask = cpumask_of(0); |
| 222 | ced->set_mode = sh_mtu2_clock_event_mode; | 222 | ced->set_mode = sh_mtu2_clock_event_mode; |
| 223 | 223 | ||
| 224 | pr_info("sh_mtu2: %s used for clock events\n", ced->name); | ||
| 225 | clockevents_register_device(ced); | ||
| 226 | |||
| 224 | ret = setup_irq(p->irqaction.irq, &p->irqaction); | 227 | ret = setup_irq(p->irqaction.irq, &p->irqaction); |
| 225 | if (ret) { | 228 | if (ret) { |
| 226 | pr_err("sh_mtu2: failed to request irq %d\n", | 229 | pr_err("sh_mtu2: failed to request irq %d\n", |
| 227 | p->irqaction.irq); | 230 | p->irqaction.irq); |
| 228 | return; | 231 | return; |
| 229 | } | 232 | } |
| 230 | |||
| 231 | pr_info("sh_mtu2: %s used for clock events\n", ced->name); | ||
| 232 | clockevents_register_device(ced); | ||
| 233 | } | 233 | } |
| 234 | 234 | ||
| 235 | static int sh_mtu2_register(struct sh_mtu2_priv *p, char *name, | 235 | static int sh_mtu2_register(struct sh_mtu2_priv *p, char *name, |
diff --git a/drivers/clocksource/sh_tmu.c b/drivers/clocksource/sh_tmu.c index 93c2322feab7..961f5b5ef6a3 100644 --- a/drivers/clocksource/sh_tmu.c +++ b/drivers/clocksource/sh_tmu.c | |||
| @@ -323,15 +323,15 @@ static void sh_tmu_register_clockevent(struct sh_tmu_priv *p, | |||
| 323 | ced->set_next_event = sh_tmu_clock_event_next; | 323 | ced->set_next_event = sh_tmu_clock_event_next; |
| 324 | ced->set_mode = sh_tmu_clock_event_mode; | 324 | ced->set_mode = sh_tmu_clock_event_mode; |
| 325 | 325 | ||
| 326 | pr_info("sh_tmu: %s used for clock events\n", ced->name); | ||
| 327 | clockevents_register_device(ced); | ||
| 328 | |||
| 326 | ret = setup_irq(p->irqaction.irq, &p->irqaction); | 329 | ret = setup_irq(p->irqaction.irq, &p->irqaction); |
| 327 | if (ret) { | 330 | if (ret) { |
| 328 | pr_err("sh_tmu: failed to request irq %d\n", | 331 | pr_err("sh_tmu: failed to request irq %d\n", |
| 329 | p->irqaction.irq); | 332 | p->irqaction.irq); |
| 330 | return; | 333 | return; |
| 331 | } | 334 | } |
| 332 | |||
| 333 | pr_info("sh_tmu: %s used for clock events\n", ced->name); | ||
| 334 | clockevents_register_device(ced); | ||
| 335 | } | 335 | } |
| 336 | 336 | ||
| 337 | static int sh_tmu_register(struct sh_tmu_priv *p, char *name, | 337 | static int sh_tmu_register(struct sh_tmu_priv *p, char *name, |
