blob: e54a955606971ff54ba358de099e9786b53eba88 [file] [log] [blame]
From 31a7d4871fb9b8785d3a95e390b19f38c3155826 Mon Sep 17 00:00:00 2001
From: Laurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
Date: Tue, 4 Mar 2014 14:23:00 +0100
Subject: clocksource: sh_mtu2: Allocate channels dynamically
This prepares the driver for multi-channel support.
Signed-off-by: Laurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
Tested-by: Wolfram Sang <wsa@sang-engineering.com>
(cherry picked from commit c54ccb431ce6ce813bb850e8659991fc4c5bc6bc)
Signed-off-by: Simon Horman <horms+renesas@verge.net.au>
---
drivers/clocksource/sh_mtu2.c | 27 ++++++++++++++++++++-------
1 file changed, 20 insertions(+), 7 deletions(-)
diff --git a/drivers/clocksource/sh_mtu2.c b/drivers/clocksource/sh_mtu2.c
index 94a53428a556..45e1e85fcbeb 100644
--- a/drivers/clocksource/sh_mtu2.c
+++ b/drivers/clocksource/sh_mtu2.c
@@ -52,7 +52,8 @@ struct sh_mtu2_device {
void __iomem *mapbase;
struct clk *clk;
- struct sh_mtu2_channel channel;
+ struct sh_mtu2_channel *channels;
+ unsigned int num_channels;
};
static DEFINE_RAW_SPINLOCK(sh_mtu2_lock);
@@ -296,6 +297,7 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu,
{
struct sh_timer_config *cfg = pdev->dev.platform_data;
struct resource *res;
+ void __iomem *base;
int ret;
ret = -ENXIO;
@@ -315,16 +317,16 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu,
}
/*
- * Map memory, let channel.base point to our channel and mapbase to the
+ * Map memory, let base point to our channel and mapbase to the
* start/stop shared register.
*/
- mtu->channel.base = ioremap_nocache(res->start, resource_size(res));
- if (mtu->channel.base == NULL) {
+ base = ioremap_nocache(res->start, resource_size(res));
+ if (base == NULL) {
dev_err(&mtu->pdev->dev, "failed to remap I/O memory\n");
goto err0;
}
- mtu->mapbase = mtu->channel.base + cfg->channel_offset;
+ mtu->mapbase = base + cfg->channel_offset;
/* get hold of clock */
mtu->clk = clk_get(&mtu->pdev->dev, "mtu2_fck");
@@ -338,17 +340,28 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu,
if (ret < 0)
goto err2;
- ret = sh_mtu2_setup_channel(&mtu->channel, mtu);
+ mtu->channels = kzalloc(sizeof(*mtu->channels), GFP_KERNEL);
+ if (mtu->channels == NULL) {
+ ret = -ENOMEM;
+ goto err3;
+ }
+
+ mtu->num_channels = 1;
+
+ mtu->channels[0].base = base;
+
+ ret = sh_mtu2_setup_channel(&mtu->channels[0], mtu);
if (ret < 0)
goto err3;
return 0;
err3:
+ kfree(mtu->channels);
clk_unprepare(mtu->clk);
err2:
clk_put(mtu->clk);
err1:
- iounmap(mtu->channel.base);
+ iounmap(base);
err0:
return ret;
}
--
2.1.2