Skip to content

Commit

Permalink
clocksource: sh_mtu2: Allocate channels dynamically
Browse files Browse the repository at this point in the history
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>
  • Loading branch information
Laurent Pinchart committed Apr 16, 2014
1 parent 810c651 commit c54ccb4
Showing 1 changed file with 20 additions and 7 deletions.
27 changes: 20 additions & 7 deletions drivers/clocksource/sh_mtu2.c
Original file line number Diff line number Diff line change
Expand Up @@ -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);
Expand Down Expand Up @@ -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;

Expand All @@ -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");
Expand All @@ -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;
}
Expand Down

0 comments on commit c54ccb4

Please sign in to comment.