Commit c54ccb43 authored by Laurent Pinchart's avatar Laurent Pinchart

clocksource: sh_mtu2: Allocate channels dynamically

This prepares the driver for multi-channel support.
Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
Tested-by: default avatarWolfram Sang <wsa@sang-engineering.com>
parent 810c6513
...@@ -52,7 +52,8 @@ struct sh_mtu2_device { ...@@ -52,7 +52,8 @@ struct sh_mtu2_device {
void __iomem *mapbase; void __iomem *mapbase;
struct clk *clk; struct clk *clk;
struct sh_mtu2_channel channel; struct sh_mtu2_channel *channels;
unsigned int num_channels;
}; };
static DEFINE_RAW_SPINLOCK(sh_mtu2_lock); static DEFINE_RAW_SPINLOCK(sh_mtu2_lock);
...@@ -296,6 +297,7 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu, ...@@ -296,6 +297,7 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu,
{ {
struct sh_timer_config *cfg = pdev->dev.platform_data; struct sh_timer_config *cfg = pdev->dev.platform_data;
struct resource *res; struct resource *res;
void __iomem *base;
int ret; int ret;
ret = -ENXIO; ret = -ENXIO;
...@@ -315,16 +317,16 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu, ...@@ -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. * start/stop shared register.
*/ */
mtu->channel.base = ioremap_nocache(res->start, resource_size(res)); base = ioremap_nocache(res->start, resource_size(res));
if (mtu->channel.base == NULL) { if (base == NULL) {
dev_err(&mtu->pdev->dev, "failed to remap I/O memory\n"); dev_err(&mtu->pdev->dev, "failed to remap I/O memory\n");
goto err0; goto err0;
} }
mtu->mapbase = mtu->channel.base + cfg->channel_offset; mtu->mapbase = base + cfg->channel_offset;
/* get hold of clock */ /* get hold of clock */
mtu->clk = clk_get(&mtu->pdev->dev, "mtu2_fck"); mtu->clk = clk_get(&mtu->pdev->dev, "mtu2_fck");
...@@ -338,17 +340,28 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu, ...@@ -338,17 +340,28 @@ static int sh_mtu2_setup(struct sh_mtu2_device *mtu,
if (ret < 0) if (ret < 0)
goto err2; 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) if (ret < 0)
goto err3; goto err3;
return 0; return 0;
err3: err3:
kfree(mtu->channels);
clk_unprepare(mtu->clk); clk_unprepare(mtu->clk);
err2: err2:
clk_put(mtu->clk); clk_put(mtu->clk);
err1: err1:
iounmap(mtu->channel.base); iounmap(base);
err0: err0:
return ret; return ret;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment