TWxSoftware/twx-linux
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

PM / devfreq: event: add support for rk3368 dfi

Browse Source 
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>
This commit is contained in:
Finley Xiao
2017-03-27 11:09:51 +08:00
committed by Tao Huang
parent 3d702d5993
commit f869a7da50
2 changed files with 150 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Documentation/devicetree/bindings/devfreq/event/rockchip-dfi.txt
+9 -2
View File
@@ -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
drivers/devfreq/event/rockchip-dfi.c
+141 -20
View File
@@ -26,6 +26,15 @@
#include <linux/list.h>
#include <linux/of.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 */
@@ -72,9 +81,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);
@@ -187,23 +264,31 @@ static const struct devfreq_event_ops rockchip_dfi_ops = {
.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 int rockchip_dfi_probe(struct platform_device *pdev)
static __init int rk3368_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 resource *res;
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;
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 resource *res;
struct device_node *np = pdev->dev.of_node, *node;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
data->regs = devm_ioremap_resource(&pdev->dev, res);
@@ -223,23 +308,59 @@ static int rockchip_dfi_probe(struct platform_device *pdev)
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);