From: Ran Bi <ran...@mediatek.com>

This add support for the MediaTek MT6358 RTC. Driver using
compatible data to store different RTC_WRTGR address offset.

Signed-off-by: Ran Bi <ran...@mediatek.com>
---
 drivers/rtc/rtc-mt6397.c | 43 ++++++++++++++++++++++++++++++++--------
 1 file changed, 35 insertions(+), 8 deletions(-)

diff --git a/drivers/rtc/rtc-mt6397.c b/drivers/rtc/rtc-mt6397.c
index f85f1fc29e32..3476e29db87c 100644
--- a/drivers/rtc/rtc-mt6397.c
+++ b/drivers/rtc/rtc-mt6397.c
@@ -20,6 +20,7 @@
 #include <linux/irqdomain.h>
 #include <linux/platform_device.h>
 #include <linux/of_address.h>
+#include <linux/of_device.h>
 #include <linux/of_irq.h>
 #include <linux/io.h>
 #include <linux/mfd/mt6397/core.h>
@@ -27,7 +28,8 @@
 #define RTC_BBPU               0x0000
 #define RTC_BBPU_CBUSY         BIT(6)
 
-#define RTC_WRTGR              0x003c
+#define RTC_WRTGR_MT6358       0x3a
+#define RTC_WRTGR_MT6397       0x3c
 
 #define RTC_IRQ_STA            0x0002
 #define RTC_IRQ_STA_AL         BIT(0)
@@ -71,6 +73,10 @@
 #define RTC_NUM_YEARS          128
 #define RTC_MIN_YEAR_OFFSET    (RTC_MIN_YEAR - RTC_BASE_YEAR)
 
+struct mtk_rtc_compatible {
+       u32                     wrtgr_addr;
+};
+
 struct mt6397_rtc {
        struct device           *dev;
        struct rtc_device       *rtc_dev;
@@ -78,7 +84,25 @@ struct mt6397_rtc {
        struct regmap           *regmap;
        int                     irq;
        u32                     addr_base;
+       const struct mtk_rtc_compatible *dev_comp;
+};
+
+static const struct mtk_rtc_compatible mt6358_rtc_compat = {
+       .wrtgr_addr = RTC_WRTGR_MT6358,
+};
+
+static const struct mtk_rtc_compatible mt6397_rtc_compat = {
+       .wrtgr_addr = RTC_WRTGR_MT6397,
+};
+
+static const struct of_device_id mt6397_rtc_of_match[] = {
+       { .compatible = "mediatek,mt6358-rtc",
+               .data = (void *)&mt6358_rtc_compat, },
+       { .compatible = "mediatek,mt6397-rtc",
+               .data = (void *)&mt6397_rtc_compat, },
+       {}
 };
+MODULE_DEVICE_TABLE(of, mt6397_rtc_of_match);
 
 static int mtk_rtc_write_trigger(struct mt6397_rtc *rtc)
 {
@@ -86,7 +110,8 @@ static int mtk_rtc_write_trigger(struct mt6397_rtc *rtc)
        int ret;
        u32 data;
 
-       ret = regmap_write(rtc->regmap, rtc->addr_base + RTC_WRTGR, 1);
+       ret = regmap_write(rtc->regmap,
+                          rtc->addr_base + rtc->dev_comp->wrtgr_addr, 1);
        if (ret < 0)
                return ret;
 
@@ -332,6 +357,7 @@ static int mtk_rtc_probe(struct platform_device *pdev)
        struct resource *res;
        struct mt6397_chip *mt6397_chip = dev_get_drvdata(pdev->dev.parent);
        struct mt6397_rtc *rtc;
+       const struct of_device_id *of_id;
        int ret;
 
        rtc = devm_kzalloc(&pdev->dev, sizeof(struct mt6397_rtc), GFP_KERNEL);
@@ -341,6 +367,13 @@ static int mtk_rtc_probe(struct platform_device *pdev)
        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
        rtc->addr_base = res->start;
 
+       of_id = of_match_device(mt6397_rtc_of_match, &pdev->dev);
+       if (!of_id) {
+               dev_err(&pdev->dev, "Failed to probe of_node\n");
+               return -EINVAL;
+       }
+       rtc->dev_comp = of_id->data;
+
        rtc->irq = platform_get_irq(pdev, 0);
        if (rtc->irq < 0)
                return rtc->irq;
@@ -419,12 +452,6 @@ static int mt6397_rtc_resume(struct device *dev)
 static SIMPLE_DEV_PM_OPS(mt6397_pm_ops, mt6397_rtc_suspend,
                        mt6397_rtc_resume);
 
-static const struct of_device_id mt6397_rtc_of_match[] = {
-       { .compatible = "mediatek,mt6397-rtc", },
-       { }
-};
-MODULE_DEVICE_TABLE(of, mt6397_rtc_of_match);
-
 static struct platform_driver mtk_rtc_driver = {
        .driver = {
                .name = "mt6397-rtc",
-- 
2.18.0

Reply via email to