clocksource: sh_tmu: Allocate channels dynamically
This prepares the driver for multi-channel support. Signed-off-by: Laurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
This commit is contained in:
parent
3b77a83eea
commit
a5de49f436
|
@ -58,7 +58,8 @@ struct sh_tmu_device {
|
||||||
void __iomem *mapbase;
|
void __iomem *mapbase;
|
||||||
struct clk *clk;
|
struct clk *clk;
|
||||||
|
|
||||||
struct sh_tmu_channel channel;
|
struct sh_tmu_channel *channels;
|
||||||
|
unsigned int num_channels;
|
||||||
};
|
};
|
||||||
|
|
||||||
static DEFINE_RAW_SPINLOCK(sh_tmu_lock);
|
static DEFINE_RAW_SPINLOCK(sh_tmu_lock);
|
||||||
|
@ -469,6 +470,7 @@ static int sh_tmu_setup(struct sh_tmu_device *tmu, struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
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;
|
||||||
|
|
||||||
|
@ -488,16 +490,16 @@ static int sh_tmu_setup(struct sh_tmu_device *tmu, struct platform_device *pdev)
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* 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.
|
||||||
*/
|
*/
|
||||||
tmu->channel.base = ioremap_nocache(res->start, resource_size(res));
|
base = ioremap_nocache(res->start, resource_size(res));
|
||||||
if (tmu->channel.base == NULL) {
|
if (base == NULL) {
|
||||||
dev_err(&tmu->pdev->dev, "failed to remap I/O memory\n");
|
dev_err(&tmu->pdev->dev, "failed to remap I/O memory\n");
|
||||||
goto err0;
|
goto err0;
|
||||||
}
|
}
|
||||||
|
|
||||||
tmu->mapbase = tmu->channel.base - cfg->channel_offset;
|
tmu->mapbase = base - cfg->channel_offset;
|
||||||
|
|
||||||
/* get hold of clock */
|
/* get hold of clock */
|
||||||
tmu->clk = clk_get(&tmu->pdev->dev, "tmu_fck");
|
tmu->clk = clk_get(&tmu->pdev->dev, "tmu_fck");
|
||||||
|
@ -511,18 +513,29 @@ static int sh_tmu_setup(struct sh_tmu_device *tmu, struct platform_device *pdev)
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
goto err2;
|
goto err2;
|
||||||
|
|
||||||
ret = sh_tmu_channel_setup(&tmu->channel, tmu);
|
tmu->channels = kzalloc(sizeof(*tmu->channels), GFP_KERNEL);
|
||||||
|
if (tmu->channels == NULL) {
|
||||||
|
ret = -ENOMEM;
|
||||||
|
goto err3;
|
||||||
|
}
|
||||||
|
|
||||||
|
tmu->num_channels = 1;
|
||||||
|
|
||||||
|
tmu->channels[0].base = base;
|
||||||
|
|
||||||
|
ret = sh_tmu_channel_setup(&tmu->channels[0], tmu);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
goto err3;
|
goto err3;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err3:
|
err3:
|
||||||
|
kfree(tmu->channels);
|
||||||
clk_unprepare(tmu->clk);
|
clk_unprepare(tmu->clk);
|
||||||
err2:
|
err2:
|
||||||
clk_put(tmu->clk);
|
clk_put(tmu->clk);
|
||||||
err1:
|
err1:
|
||||||
iounmap(tmu->channel.base);
|
iounmap(base);
|
||||||
err0:
|
err0:
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue