|
@@ -24,6 +24,7 @@
|
|
|
#include <linux/ioport.h>
|
|
|
#include <linux/irq.h>
|
|
|
#include <linux/module.h>
|
|
|
+#include <linux/of.h>
|
|
|
#include <linux/platform_device.h>
|
|
|
#include <linux/pm_domain.h>
|
|
|
#include <linux/pm_runtime.h>
|
|
@@ -114,14 +115,15 @@ struct sh_cmt_device {
|
|
|
struct platform_device *pdev;
|
|
|
|
|
|
const struct sh_cmt_info *info;
|
|
|
- bool legacy;
|
|
|
|
|
|
- void __iomem *mapbase_ch;
|
|
|
void __iomem *mapbase;
|
|
|
struct clk *clk;
|
|
|
|
|
|
+ raw_spinlock_t lock; /* Protect the shared start/stop register */
|
|
|
+
|
|
|
struct sh_cmt_channel *channels;
|
|
|
unsigned int num_channels;
|
|
|
+ unsigned int hw_channels;
|
|
|
|
|
|
bool has_clockevent;
|
|
|
bool has_clocksource;
|
|
@@ -301,14 +303,12 @@ static unsigned long sh_cmt_get_counter(struct sh_cmt_channel *ch,
|
|
|
return v2;
|
|
|
}
|
|
|
|
|
|
-static DEFINE_RAW_SPINLOCK(sh_cmt_lock);
|
|
|
-
|
|
|
static void sh_cmt_start_stop_ch(struct sh_cmt_channel *ch, int start)
|
|
|
{
|
|
|
unsigned long flags, value;
|
|
|
|
|
|
/* start stop register shared by multiple timer channels */
|
|
|
- raw_spin_lock_irqsave(&sh_cmt_lock, flags);
|
|
|
+ raw_spin_lock_irqsave(&ch->cmt->lock, flags);
|
|
|
value = sh_cmt_read_cmstr(ch);
|
|
|
|
|
|
if (start)
|
|
@@ -317,7 +317,7 @@ static void sh_cmt_start_stop_ch(struct sh_cmt_channel *ch, int start)
|
|
|
value &= ~(1 << ch->timer_bit);
|
|
|
|
|
|
sh_cmt_write_cmstr(ch, value);
|
|
|
- raw_spin_unlock_irqrestore(&sh_cmt_lock, flags);
|
|
|
+ raw_spin_unlock_irqrestore(&ch->cmt->lock, flags);
|
|
|
}
|
|
|
|
|
|
static int sh_cmt_enable(struct sh_cmt_channel *ch, unsigned long *rate)
|
|
@@ -792,7 +792,7 @@ static int sh_cmt_register_clockevent(struct sh_cmt_channel *ch,
|
|
|
int irq;
|
|
|
int ret;
|
|
|
|
|
|
- irq = platform_get_irq(ch->cmt->pdev, ch->cmt->legacy ? 0 : ch->index);
|
|
|
+ irq = platform_get_irq(ch->cmt->pdev, ch->index);
|
|
|
if (irq < 0) {
|
|
|
dev_err(&ch->cmt->pdev->dev, "ch%u: failed to get irq\n",
|
|
|
ch->index);
|
|
@@ -863,33 +863,26 @@ static int sh_cmt_setup_channel(struct sh_cmt_channel *ch, unsigned int index,
|
|
|
* Compute the address of the channel control register block. For the
|
|
|
* timers with a per-channel start/stop register, compute its address
|
|
|
* as well.
|
|
|
- *
|
|
|
- * For legacy configuration the address has been mapped explicitly.
|
|
|
*/
|
|
|
- if (cmt->legacy) {
|
|
|
- ch->ioctrl = cmt->mapbase_ch;
|
|
|
- } else {
|
|
|
- switch (cmt->info->model) {
|
|
|
- case SH_CMT_16BIT:
|
|
|
- ch->ioctrl = cmt->mapbase + 2 + ch->hwidx * 6;
|
|
|
- break;
|
|
|
- case SH_CMT_32BIT:
|
|
|
- case SH_CMT_48BIT:
|
|
|
- ch->ioctrl = cmt->mapbase + 0x10 + ch->hwidx * 0x10;
|
|
|
- break;
|
|
|
- case SH_CMT_32BIT_FAST:
|
|
|
- /*
|
|
|
- * The 32-bit "fast" timer has a single channel at hwidx
|
|
|
- * 5 but is located at offset 0x40 instead of 0x60 for
|
|
|
- * some reason.
|
|
|
- */
|
|
|
- ch->ioctrl = cmt->mapbase + 0x40;
|
|
|
- break;
|
|
|
- case SH_CMT_48BIT_GEN2:
|
|
|
- ch->iostart = cmt->mapbase + ch->hwidx * 0x100;
|
|
|
- ch->ioctrl = ch->iostart + 0x10;
|
|
|
- break;
|
|
|
- }
|
|
|
+ switch (cmt->info->model) {
|
|
|
+ case SH_CMT_16BIT:
|
|
|
+ ch->ioctrl = cmt->mapbase + 2 + ch->hwidx * 6;
|
|
|
+ break;
|
|
|
+ case SH_CMT_32BIT:
|
|
|
+ case SH_CMT_48BIT:
|
|
|
+ ch->ioctrl = cmt->mapbase + 0x10 + ch->hwidx * 0x10;
|
|
|
+ break;
|
|
|
+ case SH_CMT_32BIT_FAST:
|
|
|
+ /*
|
|
|
+ * The 32-bit "fast" timer has a single channel at hwidx 5 but
|
|
|
+ * is located at offset 0x40 instead of 0x60 for some reason.
|
|
|
+ */
|
|
|
+ ch->ioctrl = cmt->mapbase + 0x40;
|
|
|
+ break;
|
|
|
+ case SH_CMT_48BIT_GEN2:
|
|
|
+ ch->iostart = cmt->mapbase + ch->hwidx * 0x100;
|
|
|
+ ch->ioctrl = ch->iostart + 0x10;
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
if (cmt->info->width == (sizeof(ch->max_match_value) * 8))
|
|
@@ -900,12 +893,7 @@ static int sh_cmt_setup_channel(struct sh_cmt_channel *ch, unsigned int index,
|
|
|
ch->match_value = ch->max_match_value;
|
|
|
raw_spin_lock_init(&ch->lock);
|
|
|
|
|
|
- if (cmt->legacy) {
|
|
|
- ch->timer_bit = ch->hwidx;
|
|
|
- } else {
|
|
|
- ch->timer_bit = cmt->info->model == SH_CMT_48BIT_GEN2
|
|
|
- ? 0 : ch->hwidx;
|
|
|
- }
|
|
|
+ ch->timer_bit = cmt->info->model == SH_CMT_48BIT_GEN2 ? 0 : ch->hwidx;
|
|
|
|
|
|
ret = sh_cmt_register(ch, dev_name(&cmt->pdev->dev),
|
|
|
clockevent, clocksource);
|
|
@@ -938,75 +926,65 @@ static int sh_cmt_map_memory(struct sh_cmt_device *cmt)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-static int sh_cmt_map_memory_legacy(struct sh_cmt_device *cmt)
|
|
|
-{
|
|
|
- struct sh_timer_config *cfg = cmt->pdev->dev.platform_data;
|
|
|
- struct resource *res, *res2;
|
|
|
-
|
|
|
- /* map memory, let mapbase_ch point to our channel */
|
|
|
- res = platform_get_resource(cmt->pdev, IORESOURCE_MEM, 0);
|
|
|
- if (!res) {
|
|
|
- dev_err(&cmt->pdev->dev, "failed to get I/O memory\n");
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
-
|
|
|
- cmt->mapbase_ch = ioremap_nocache(res->start, resource_size(res));
|
|
|
- if (cmt->mapbase_ch == NULL) {
|
|
|
- dev_err(&cmt->pdev->dev, "failed to remap I/O memory\n");
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
-
|
|
|
- /* optional resource for the shared timer start/stop register */
|
|
|
- res2 = platform_get_resource(cmt->pdev, IORESOURCE_MEM, 1);
|
|
|
-
|
|
|
- /* map second resource for CMSTR */
|
|
|
- cmt->mapbase = ioremap_nocache(res2 ? res2->start :
|
|
|
- res->start - cfg->channel_offset,
|
|
|
- res2 ? resource_size(res2) : 2);
|
|
|
- if (cmt->mapbase == NULL) {
|
|
|
- dev_err(&cmt->pdev->dev, "failed to remap I/O second memory\n");
|
|
|
- iounmap(cmt->mapbase_ch);
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
-
|
|
|
- /* identify the model based on the resources */
|
|
|
- if (resource_size(res) == 6)
|
|
|
- cmt->info = &sh_cmt_info[SH_CMT_16BIT];
|
|
|
- else if (res2 && (resource_size(res2) == 4))
|
|
|
- cmt->info = &sh_cmt_info[SH_CMT_48BIT_GEN2];
|
|
|
- else
|
|
|
- cmt->info = &sh_cmt_info[SH_CMT_32BIT];
|
|
|
+static const struct platform_device_id sh_cmt_id_table[] = {
|
|
|
+ { "sh-cmt-16", (kernel_ulong_t)&sh_cmt_info[SH_CMT_16BIT] },
|
|
|
+ { "sh-cmt-32", (kernel_ulong_t)&sh_cmt_info[SH_CMT_32BIT] },
|
|
|
+ { "sh-cmt-32-fast", (kernel_ulong_t)&sh_cmt_info[SH_CMT_32BIT_FAST] },
|
|
|
+ { "sh-cmt-48", (kernel_ulong_t)&sh_cmt_info[SH_CMT_48BIT] },
|
|
|
+ { "sh-cmt-48-gen2", (kernel_ulong_t)&sh_cmt_info[SH_CMT_48BIT_GEN2] },
|
|
|
+ { }
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(platform, sh_cmt_id_table);
|
|
|
|
|
|
- return 0;
|
|
|
-}
|
|
|
+static const struct of_device_id sh_cmt_of_table[] __maybe_unused = {
|
|
|
+ { .compatible = "renesas,cmt-32", .data = &sh_cmt_info[SH_CMT_32BIT] },
|
|
|
+ { .compatible = "renesas,cmt-32-fast", .data = &sh_cmt_info[SH_CMT_32BIT_FAST] },
|
|
|
+ { .compatible = "renesas,cmt-48", .data = &sh_cmt_info[SH_CMT_48BIT] },
|
|
|
+ { .compatible = "renesas,cmt-48-gen2", .data = &sh_cmt_info[SH_CMT_48BIT_GEN2] },
|
|
|
+ { }
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, sh_cmt_of_table);
|
|
|
|
|
|
-static void sh_cmt_unmap_memory(struct sh_cmt_device *cmt)
|
|
|
+static int sh_cmt_parse_dt(struct sh_cmt_device *cmt)
|
|
|
{
|
|
|
- iounmap(cmt->mapbase);
|
|
|
- if (cmt->mapbase_ch)
|
|
|
- iounmap(cmt->mapbase_ch);
|
|
|
+ struct device_node *np = cmt->pdev->dev.of_node;
|
|
|
+
|
|
|
+ return of_property_read_u32(np, "renesas,channels-mask",
|
|
|
+ &cmt->hw_channels);
|
|
|
}
|
|
|
|
|
|
static int sh_cmt_setup(struct sh_cmt_device *cmt, struct platform_device *pdev)
|
|
|
{
|
|
|
- struct sh_timer_config *cfg = pdev->dev.platform_data;
|
|
|
- const struct platform_device_id *id = pdev->id_entry;
|
|
|
- unsigned int hw_channels;
|
|
|
+ unsigned int mask;
|
|
|
+ unsigned int i;
|
|
|
int ret;
|
|
|
|
|
|
memset(cmt, 0, sizeof(*cmt));
|
|
|
cmt->pdev = pdev;
|
|
|
+ raw_spin_lock_init(&cmt->lock);
|
|
|
+
|
|
|
+ if (IS_ENABLED(CONFIG_OF) && pdev->dev.of_node) {
|
|
|
+ const struct of_device_id *id;
|
|
|
+
|
|
|
+ id = of_match_node(sh_cmt_of_table, pdev->dev.of_node);
|
|
|
+ cmt->info = id->data;
|
|
|
|
|
|
- if (!cfg) {
|
|
|
+ ret = sh_cmt_parse_dt(cmt);
|
|
|
+ if (ret < 0)
|
|
|
+ return ret;
|
|
|
+ } else if (pdev->dev.platform_data) {
|
|
|
+ struct sh_timer_config *cfg = pdev->dev.platform_data;
|
|
|
+ const struct platform_device_id *id = pdev->id_entry;
|
|
|
+
|
|
|
+ cmt->info = (const struct sh_cmt_info *)id->driver_data;
|
|
|
+ cmt->hw_channels = cfg->channels_mask;
|
|
|
+ } else {
|
|
|
dev_err(&cmt->pdev->dev, "missing platform data\n");
|
|
|
return -ENXIO;
|
|
|
}
|
|
|
|
|
|
- cmt->info = (const struct sh_cmt_info *)id->driver_data;
|
|
|
- cmt->legacy = cmt->info ? false : true;
|
|
|
-
|
|
|
/* Get hold of clock. */
|
|
|
- cmt->clk = clk_get(&cmt->pdev->dev, cmt->legacy ? "cmt_fck" : "fck");
|
|
|
+ cmt->clk = clk_get(&cmt->pdev->dev, "fck");
|
|
|
if (IS_ERR(cmt->clk)) {
|
|
|
dev_err(&cmt->pdev->dev, "cannot get clock\n");
|
|
|
return PTR_ERR(cmt->clk);
|
|
@@ -1016,28 +994,13 @@ static int sh_cmt_setup(struct sh_cmt_device *cmt, struct platform_device *pdev)
|
|
|
if (ret < 0)
|
|
|
goto err_clk_put;
|
|
|
|
|
|
- /*
|
|
|
- * Map the memory resource(s). We need to support both the legacy
|
|
|
- * platform device configuration (with one device per channel) and the
|
|
|
- * new version (with multiple channels per device).
|
|
|
- */
|
|
|
- if (cmt->legacy)
|
|
|
- ret = sh_cmt_map_memory_legacy(cmt);
|
|
|
- else
|
|
|
- ret = sh_cmt_map_memory(cmt);
|
|
|
-
|
|
|
+ /* Map the memory resource(s). */
|
|
|
+ ret = sh_cmt_map_memory(cmt);
|
|
|
if (ret < 0)
|
|
|
goto err_clk_unprepare;
|
|
|
|
|
|
/* Allocate and setup the channels. */
|
|
|
- if (cmt->legacy) {
|
|
|
- cmt->num_channels = 1;
|
|
|
- hw_channels = 0;
|
|
|
- } else {
|
|
|
- cmt->num_channels = hweight8(cfg->channels_mask);
|
|
|
- hw_channels = cfg->channels_mask;
|
|
|
- }
|
|
|
-
|
|
|
+ cmt->num_channels = hweight8(cmt->hw_channels);
|
|
|
cmt->channels = kzalloc(cmt->num_channels * sizeof(*cmt->channels),
|
|
|
GFP_KERNEL);
|
|
|
if (cmt->channels == NULL) {
|
|
@@ -1045,35 +1008,21 @@ static int sh_cmt_setup(struct sh_cmt_device *cmt, struct platform_device *pdev)
|
|
|
goto err_unmap;
|
|
|
}
|
|
|
|
|
|
- if (cmt->legacy) {
|
|
|
- ret = sh_cmt_setup_channel(&cmt->channels[0],
|
|
|
- cfg->timer_bit, cfg->timer_bit,
|
|
|
- cfg->clockevent_rating != 0,
|
|
|
- cfg->clocksource_rating != 0, cmt);
|
|
|
+ /*
|
|
|
+ * Use the first channel as a clock event device and the second channel
|
|
|
+ * as a clock source. If only one channel is available use it for both.
|
|
|
+ */
|
|
|
+ for (i = 0, mask = cmt->hw_channels; i < cmt->num_channels; ++i) {
|
|
|
+ unsigned int hwidx = ffs(mask) - 1;
|
|
|
+ bool clocksource = i == 1 || cmt->num_channels == 1;
|
|
|
+ bool clockevent = i == 0;
|
|
|
+
|
|
|
+ ret = sh_cmt_setup_channel(&cmt->channels[i], i, hwidx,
|
|
|
+ clockevent, clocksource, cmt);
|
|
|
if (ret < 0)
|
|
|
goto err_unmap;
|
|
|
- } else {
|
|
|
- unsigned int mask = hw_channels;
|
|
|
- unsigned int i;
|
|
|
|
|
|
- /*
|
|
|
- * Use the first channel as a clock event device and the second
|
|
|
- * channel as a clock source. If only one channel is available
|
|
|
- * use it for both.
|
|
|
- */
|
|
|
- for (i = 0; i < cmt->num_channels; ++i) {
|
|
|
- unsigned int hwidx = ffs(mask) - 1;
|
|
|
- bool clocksource = i == 1 || cmt->num_channels == 1;
|
|
|
- bool clockevent = i == 0;
|
|
|
-
|
|
|
- ret = sh_cmt_setup_channel(&cmt->channels[i], i, hwidx,
|
|
|
- clockevent, clocksource,
|
|
|
- cmt);
|
|
|
- if (ret < 0)
|
|
|
- goto err_unmap;
|
|
|
-
|
|
|
- mask &= ~(1 << hwidx);
|
|
|
- }
|
|
|
+ mask &= ~(1 << hwidx);
|
|
|
}
|
|
|
|
|
|
platform_set_drvdata(pdev, cmt);
|
|
@@ -1082,7 +1031,7 @@ static int sh_cmt_setup(struct sh_cmt_device *cmt, struct platform_device *pdev)
|
|
|
|
|
|
err_unmap:
|
|
|
kfree(cmt->channels);
|
|
|
- sh_cmt_unmap_memory(cmt);
|
|
|
+ iounmap(cmt->mapbase);
|
|
|
err_clk_unprepare:
|
|
|
clk_unprepare(cmt->clk);
|
|
|
err_clk_put:
|
|
@@ -1132,22 +1081,12 @@ static int sh_cmt_remove(struct platform_device *pdev)
|
|
|
return -EBUSY; /* cannot unregister clockevent and clocksource */
|
|
|
}
|
|
|
|
|
|
-static const struct platform_device_id sh_cmt_id_table[] = {
|
|
|
- { "sh_cmt", 0 },
|
|
|
- { "sh-cmt-16", (kernel_ulong_t)&sh_cmt_info[SH_CMT_16BIT] },
|
|
|
- { "sh-cmt-32", (kernel_ulong_t)&sh_cmt_info[SH_CMT_32BIT] },
|
|
|
- { "sh-cmt-32-fast", (kernel_ulong_t)&sh_cmt_info[SH_CMT_32BIT_FAST] },
|
|
|
- { "sh-cmt-48", (kernel_ulong_t)&sh_cmt_info[SH_CMT_48BIT] },
|
|
|
- { "sh-cmt-48-gen2", (kernel_ulong_t)&sh_cmt_info[SH_CMT_48BIT_GEN2] },
|
|
|
- { }
|
|
|
-};
|
|
|
-MODULE_DEVICE_TABLE(platform, sh_cmt_id_table);
|
|
|
-
|
|
|
static struct platform_driver sh_cmt_device_driver = {
|
|
|
.probe = sh_cmt_probe,
|
|
|
.remove = sh_cmt_remove,
|
|
|
.driver = {
|
|
|
.name = "sh_cmt",
|
|
|
+ .of_match_table = of_match_ptr(sh_cmt_of_table),
|
|
|
},
|
|
|
.id_table = sh_cmt_id_table,
|
|
|
};
|