242 lines
6.9 KiB
Diff
242 lines
6.9 KiB
Diff
From b495cbf3597ca0799c35c8bb4a12b8e70b911820 Mon Sep 17 00:00:00 2001
|
|
From: Finley Xiao <finley.xiao@rock-chips.com>
|
|
Date: Mon, 27 Mar 2017 11:09:51 +0800
|
|
Subject: [PATCH] PM / devfreq: event: add support for rk3368 dfi
|
|
|
|
This adds the necessary data for handling dfi on the rk3368.
|
|
Access the dfi via registers provided by GRF (general register
|
|
files) module.
|
|
|
|
Change-Id: I96c2b4dcd34d90731b749ebdbe6922f01559d8e6
|
|
Signed-off-by: Finley Xiao <finley.xiao@rock-chips.com>
|
|
---
|
|
.../bindings/devfreq/event/rockchip-dfi.txt | 11 +-
|
|
drivers/devfreq/event/rockchip-dfi.c | 157 ++++++++++++++++--
|
|
2 files changed, 148 insertions(+), 20 deletions(-)
|
|
|
|
--- a/Documentation/devicetree/bindings/devfreq/event/rockchip-dfi.txt
|
|
+++ b/Documentation/devicetree/bindings/devfreq/event/rockchip-dfi.txt
|
|
@@ -1,8 +1,15 @@
|
|
|
|
-* Rockchip rk3399 DFI device
|
|
+* Rockchip DFI device
|
|
|
|
Required properties:
|
|
-- compatible: Must be "rockchip,rk3399-dfi".
|
|
+- compatible: Should be one of the following.
|
|
+ - "rockchip,rk3368-dfi" - for RK3368 SoCs.
|
|
+ - "rockchip,rk3399-dfi" - for RK3399 SoCs.
|
|
+
|
|
+Required properties for RK3368:
|
|
+- rockchip,grf: phandle to the syscon managing the "general register files"
|
|
+
|
|
+Required properties for RK3399:
|
|
- reg: physical base address of each DFI and length of memory mapped region
|
|
- rockchip,pmu: phandle to the syscon managing the "pmu general register files"
|
|
- clocks: phandles for clock specified in "clock-names" property
|
|
--- a/drivers/devfreq/event/rockchip-dfi.c
|
|
+++ b/drivers/devfreq/event/rockchip-dfi.c
|
|
@@ -20,6 +20,15 @@
|
|
|
|
#include <soc/rockchip/rk3399_grf.h>
|
|
|
|
+#define RK3368_GRF_DDRC0_CON0 0x600
|
|
+#define RK3368_GRF_SOC_STATUS5 0x494
|
|
+#define RK3368_GRF_SOC_STATUS6 0x498
|
|
+#define RK3368_GRF_SOC_STATUS8 0x4a0
|
|
+#define RK3368_GRF_SOC_STATUS9 0x4a4
|
|
+#define RK3368_GRF_SOC_STATUS10 0x4a8
|
|
+#define RK3368_DFI_EN (0x30003 << 5)
|
|
+#define RK3368_DFI_DIS (0x30000 << 5)
|
|
+
|
|
#define RK3399_DMC_NUM_CH 2
|
|
|
|
/* DDRMON_CTRL */
|
|
@@ -54,9 +63,77 @@ struct rockchip_dfi {
|
|
struct device *dev;
|
|
void __iomem *regs;
|
|
struct regmap *regmap_pmu;
|
|
+ struct regmap *regmap_grf;
|
|
struct clk *clk;
|
|
};
|
|
|
|
+static void rk3368_dfi_start_hardware_counter(struct devfreq_event_dev *edev)
|
|
+{
|
|
+ struct rockchip_dfi *info = devfreq_event_get_drvdata(edev);
|
|
+
|
|
+ regmap_write(info->regmap_grf, RK3368_GRF_DDRC0_CON0, RK3368_DFI_EN);
|
|
+}
|
|
+
|
|
+static void rk3368_dfi_stop_hardware_counter(struct devfreq_event_dev *edev)
|
|
+{
|
|
+ struct rockchip_dfi *info = devfreq_event_get_drvdata(edev);
|
|
+
|
|
+ regmap_write(info->regmap_grf, RK3368_GRF_DDRC0_CON0, RK3368_DFI_DIS);
|
|
+}
|
|
+
|
|
+static int rk3368_dfi_disable(struct devfreq_event_dev *edev)
|
|
+{
|
|
+ rk3368_dfi_stop_hardware_counter(edev);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int rk3368_dfi_enable(struct devfreq_event_dev *edev)
|
|
+{
|
|
+ rk3368_dfi_start_hardware_counter(edev);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int rk3368_dfi_set_event(struct devfreq_event_dev *edev)
|
|
+{
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int rk3368_dfi_get_event(struct devfreq_event_dev *edev,
|
|
+ struct devfreq_event_data *edata)
|
|
+{
|
|
+ struct rockchip_dfi *info = devfreq_event_get_drvdata(edev);
|
|
+ unsigned long flags;
|
|
+ u32 dfi0_wr, dfi0_rd, dfi1_wr, dfi1_rd, dfi_timer;
|
|
+
|
|
+ local_irq_save(flags);
|
|
+
|
|
+ rk3368_dfi_stop_hardware_counter(edev);
|
|
+
|
|
+ regmap_read(info->regmap_grf, RK3368_GRF_SOC_STATUS5, &dfi0_wr);
|
|
+ regmap_read(info->regmap_grf, RK3368_GRF_SOC_STATUS6, &dfi0_rd);
|
|
+ regmap_read(info->regmap_grf, RK3368_GRF_SOC_STATUS9, &dfi1_wr);
|
|
+ regmap_read(info->regmap_grf, RK3368_GRF_SOC_STATUS10, &dfi1_rd);
|
|
+ regmap_read(info->regmap_grf, RK3368_GRF_SOC_STATUS8, &dfi_timer);
|
|
+
|
|
+ edata->load_count = (dfi0_wr + dfi0_rd + dfi1_wr + dfi1_rd) * 2;
|
|
+ edata->total_count = dfi_timer;
|
|
+
|
|
+ rk3368_dfi_start_hardware_counter(edev);
|
|
+
|
|
+ local_irq_restore(flags);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct devfreq_event_ops rk3368_dfi_ops = {
|
|
+ .disable = rk3368_dfi_disable,
|
|
+ .enable = rk3368_dfi_enable,
|
|
+ .get_event = rk3368_dfi_get_event,
|
|
+ .set_event = rk3368_dfi_set_event,
|
|
+};
|
|
+
|
|
static void rockchip_dfi_start_hardware_counter(struct devfreq_event_dev *edev)
|
|
{
|
|
struct rockchip_dfi *info = devfreq_event_get_drvdata(edev);
|
|
@@ -170,23 +247,31 @@ static const struct devfreq_event_ops ro
|
|
.set_event = rockchip_dfi_set_event,
|
|
};
|
|
|
|
-static const struct of_device_id rockchip_dfi_id_match[] = {
|
|
- { .compatible = "rockchip,rk3399-dfi" },
|
|
- { },
|
|
-};
|
|
-MODULE_DEVICE_TABLE(of, rockchip_dfi_id_match);
|
|
+static __init int rk3368_dfi_init(struct platform_device *pdev,
|
|
+ struct rockchip_dfi *data,
|
|
+ struct devfreq_event_desc *desc)
|
|
+{
|
|
+ struct device *dev = &pdev->dev;
|
|
|
|
-static int rockchip_dfi_probe(struct platform_device *pdev)
|
|
+ if (!dev->parent || !dev->parent->of_node)
|
|
+ return -EINVAL;
|
|
+
|
|
+ data->regmap_grf = syscon_node_to_regmap(dev->parent->of_node);
|
|
+ if (IS_ERR(data->regmap_grf))
|
|
+ return PTR_ERR(data->regmap_grf);
|
|
+
|
|
+ desc->ops = &rk3368_dfi_ops;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static __init int rockchip_dfi_init(struct platform_device *pdev,
|
|
+ struct rockchip_dfi *data,
|
|
+ struct devfreq_event_desc *desc)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
- struct rockchip_dfi *data;
|
|
- struct devfreq_event_desc *desc;
|
|
struct device_node *np = pdev->dev.of_node, *node;
|
|
|
|
- data = devm_kzalloc(dev, sizeof(struct rockchip_dfi), GFP_KERNEL);
|
|
- if (!data)
|
|
- return -ENOMEM;
|
|
-
|
|
data->regs = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(data->regs))
|
|
return PTR_ERR(data->regs);
|
|
@@ -206,23 +291,58 @@ static int rockchip_dfi_probe(struct pla
|
|
if (IS_ERR(data->regmap_pmu))
|
|
return PTR_ERR(data->regmap_pmu);
|
|
|
|
- data->dev = dev;
|
|
+ desc->ops = &rockchip_dfi_ops;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id rockchip_dfi_id_match[] = {
|
|
+ { .compatible = "rockchip,rk3368-dfi", .data = rk3368_dfi_init },
|
|
+ { .compatible = "rockchip,rk3399-dfi", .data = rockchip_dfi_init },
|
|
+ { },
|
|
+};
|
|
+
|
|
+static int rockchip_dfi_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct device *dev = &pdev->dev;
|
|
+ struct rockchip_dfi *data;
|
|
+ struct devfreq_event_desc *desc;
|
|
+ struct device_node *np = pdev->dev.of_node;
|
|
+ const struct of_device_id *match;
|
|
+ int (*init)(struct platform_device *pdev, struct rockchip_dfi *data,
|
|
+ struct devfreq_event_desc *desc);
|
|
+
|
|
+ data = devm_kzalloc(dev, sizeof(struct rockchip_dfi), GFP_KERNEL);
|
|
+ if (!data)
|
|
+ return -ENOMEM;
|
|
|
|
desc = devm_kzalloc(dev, sizeof(*desc), GFP_KERNEL);
|
|
if (!desc)
|
|
return -ENOMEM;
|
|
|
|
- desc->ops = &rockchip_dfi_ops;
|
|
+ match = of_match_node(rockchip_dfi_id_match, pdev->dev.of_node);
|
|
+ if (match) {
|
|
+ init = match->data;
|
|
+ if (init) {
|
|
+ if (init(pdev, data, desc))
|
|
+ return -EINVAL;
|
|
+ } else {
|
|
+ return 0;
|
|
+ }
|
|
+ } else {
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
desc->driver_data = data;
|
|
desc->name = np->name;
|
|
- data->desc = desc;
|
|
|
|
- data->edev = devm_devfreq_event_add_edev(&pdev->dev, desc);
|
|
+ data->edev = devm_devfreq_event_add_edev(dev, desc);
|
|
if (IS_ERR(data->edev)) {
|
|
- dev_err(&pdev->dev,
|
|
- "failed to add devfreq-event device\n");
|
|
+ dev_err(dev, "failed to add devfreq-event device\n");
|
|
return PTR_ERR(data->edev);
|
|
}
|
|
+ data->desc = desc;
|
|
+ data->dev = &pdev->dev;
|
|
|
|
platform_set_drvdata(pdev, data);
|
|
|