porting Mediatek timer driver to loadable module

Signed-off-by: Freddy Hsin <freddy.h...@mediatek.com>
---
 drivers/clocksource/Kconfig          |    2 +-
 drivers/clocksource/mmio.c           |    4 +++-
 drivers/clocksource/timer-mediatek.c |   39 ++++++++++++++++++++++++++++++++++
 3 files changed, 43 insertions(+), 2 deletions(-)

diff --git a/drivers/clocksource/Kconfig b/drivers/clocksource/Kconfig
index 9141838..538351a 100644
--- a/drivers/clocksource/Kconfig
+++ b/drivers/clocksource/Kconfig
@@ -472,7 +472,7 @@ config SYS_SUPPORTS_SH_CMT
        bool
 
 config MTK_TIMER
-       bool "Mediatek timer driver" if COMPILE_TEST
+       tristate "Mediatek timer driver"
        depends on HAS_IOMEM
        select TIMER_OF
        select CLKSRC_MMIO
diff --git a/drivers/clocksource/mmio.c b/drivers/clocksource/mmio.c
index 9de7515..5504569 100644
--- a/drivers/clocksource/mmio.c
+++ b/drivers/clocksource/mmio.c
@@ -21,6 +21,7 @@ u64 clocksource_mmio_readl_up(struct clocksource *c)
 {
        return (u64)readl_relaxed(to_mmio_clksrc(c)->reg);
 }
+EXPORT_SYMBOL(clocksource_mmio_readl_up);
 
 u64 clocksource_mmio_readl_down(struct clocksource *c)
 {
@@ -46,7 +47,7 @@ u64 clocksource_mmio_readw_down(struct clocksource *c)
  * @bits:      Number of valid bits
  * @read:      One of clocksource_mmio_read*() above
  */
-int __init clocksource_mmio_init(void __iomem *base, const char *name,
+int clocksource_mmio_init(void __iomem *base, const char *name,
        unsigned long hz, int rating, unsigned bits,
        u64 (*read)(struct clocksource *))
 {
@@ -68,3 +69,4 @@ int __init clocksource_mmio_init(void __iomem *base, const 
char *name,
 
        return clocksource_register_hz(&cs->clksrc, hz);
 }
+EXPORT_SYMBOL(clocksource_mmio_init);
diff --git a/drivers/clocksource/timer-mediatek.c 
b/drivers/clocksource/timer-mediatek.c
index 9318edc..5c89b6b 100644
--- a/drivers/clocksource/timer-mediatek.c
+++ b/drivers/clocksource/timer-mediatek.c
@@ -13,6 +13,9 @@
 #include <linux/clocksource.h>
 #include <linux/interrupt.h>
 #include <linux/irqreturn.h>
+#include <linux/module.h>
+#include <linux/of_device.h>
+#include <linux/platform_device.h>
 #include <linux/sched_clock.h>
 #include <linux/slab.h>
 #include "timer-of.h"
@@ -309,5 +312,41 @@ static int __init mtk_gpt_init(struct device_node *node)
 
        return 0;
 }
+
+#ifdef MODULE
+static int mtk_timer_probe(struct platform_device *pdev)
+{
+       int (*timer_init)(struct device_node *node);
+       struct device_node *np = pdev->dev.of_node;
+
+       timer_init = of_device_get_match_data(&pdev->dev);
+       return timer_init(np);
+}
+
+static const struct of_device_id mtk_timer_match_table[] = {
+       {
+               .compatible = "mediatek,mt6577-timer",
+               .data = mtk_gpt_init,
+       },
+       {
+               .compatible = "mediatek,mt6765-timer",
+               .data = mtk_syst_init,
+       },
+       {}
+};
+
+static struct platform_driver mtk_timer_driver = {
+       .probe = mtk_timer_probe,
+       .driver = {
+               .name = "mtk-timer",
+               .of_match_table = mtk_timer_match_table,
+       },
+};
+MODULE_DESCRIPTION("MEDIATEK Module timer driver");
+MODULE_LICENSE("GPL v2");
+
+module_platform_driver(mtk_timer_driver);
+#else
 TIMER_OF_DECLARE(mtk_mt6577, "mediatek,mt6577-timer", mtk_gpt_init);
 TIMER_OF_DECLARE(mtk_mt6765, "mediatek,mt6765-timer", mtk_syst_init);
+#endif
-- 
1.7.9.5

Reply via email to