UbiquitousOS
/
OpenCloudOS-Kernel
mirror of https://gitee.com/OpenCloudOS/OpenCloudOS-Kernel.git
11
0
Fork 0
Code Issues Projects Releases Wiki Activity

Samsung soc drivers changes for v5.5 

1. Minor fixes to Exynos Chipid driver.
 2. Add Exynos Adaptive Supply Voltage driver allowing to adjust voltages
    used during CPU frequency scaling based on revision of SoC.  This
    also pulls dependency from PM/OPP tree - driver uses newly added
    dev_pm_opp_adjust_voltage() function.
 -----BEGIN PGP SIGNATURE-----
 
 iQJEBAABCgAuFiEE3dJiKD0RGyM7briowTdm5oaLg9cFAl3AYfAQHGtyemtAa2Vy
 bmVsLm9yZwAKCRDBN2bmhouD12sBD/97frLC9dwXVjuQeZ8Zadu3CMagcyBAKTBX
 TjSx9Gg+MswEMm5prhNdr1X364VCp34+TpvlZjTt2oQi22cz5QgPDZYvdckjAt3c
 GRUTsFvo756Fyko0BkVyKCm9cj1ZSl+5/iJi7p+nIjowOGRIufsoHbaGw7zJrtyu
 12YpqCROubXsLE5sO0qfdsf4rTfx3o/M8HIP6p3VCB0qQ1Leapiv+t2G/c+21Br/
 EuVv02kNKbEHbLoQqV9r0Odh8X7YRsPy2FkdQNNx+55k5O7vcaS2bCB8dg0XUON0
 iiM4A6BDGgizBBDxS8Ir9jwQDxNUrRsIsd1oAoI/zo2z+UImN1GAPK187E5VPlBK
 ySuvGXbfGWjZCENTVaFuhxEgIHK+JM0QItFYNlc/7aRoCYi2aY917FI2CkddKwWx
 h7p3gPyDC5xX027+j0TP+ksU974dmk031H4StqtdcTaciYtQw9AXCtwGRq/KUQZ5
 J83X5q+xG80fzKzUb3a65n6fSImZjlvjU1lHyXdiqlQhyoF0UQGcr614KSSoo3eT
 INxpKI9tbzwuO4iSRpNrvqentYlzFiTVGO0e08x8m5u6J9PUc/GJLBGSAtTbx3ta
 nWRWPn3Jrkak1JE5sFHHg9gEwMM5fpJNIBx5SZGpzNNMDyLcmNTwDqeyl0YDx0Ir
 DU9UywLcIA==
 =t01z
 -----END PGP SIGNATURE-----

Merge tag 'samsung-drivers-5.5' of https://git.kernel.org/pub/scm/linux/kernel/git/krzk/linux into arm/drivers

Samsung soc drivers changes for v5.5

1. Minor fixes to Exynos Chipid driver.
2. Add Exynos Adaptive Supply Voltage driver allowing to adjust voltages
   used during CPU frequency scaling based on revision of SoC.  This
   also pulls dependency from PM/OPP tree - driver uses newly added
   dev_pm_opp_adjust_voltage() function.

* tag 'samsung-drivers-5.5' of https://git.kernel.org/pub/scm/linux/kernel/git/krzk/linux:
  soc: samsung: exynos-asv: Potential NULL dereference in exynos_asv_update_opps()
  soc: samsung: chipid: Drop "syscon" compatible requirement
  soc: samsung: Add Exynos Adaptive Supply Voltage driver
  PM / OPP: Support adjusting OPP voltages at runtime
  soc: samsung: chipid: Make exynos_chipid_early_init() static

Link: https://lore.kernel.org/r/20191104175902.12224-1-krzk@kernel.org
Signed-off-by: Olof Johansson <olof@lixom.net>
This commit is contained in:
Olof Johansson 2019-11-06 07:45:06 -08:00
parent b4067b1050 89e551e838
commit 171cfeec98
9 changed files with 889 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

69
drivers/opp/core.c
View File

@ -2112,6 +2112,75 @@ put_table:
return r;
}
/**
* dev_pm_opp_adjust_voltage() - helper to change the voltage of an OPP
* @dev: device for which we do this operation
* @freq: OPP frequency to adjust voltage of
* @u_volt: new OPP target voltage
* @u_volt_min: new OPP min voltage
* @u_volt_max: new OPP max voltage
*
* Return: -EINVAL for bad pointers, -ENOMEM if no memory available for the
* copy operation, returns 0 if no modifcation was done OR modification was
* successful.
*/
int dev_pm_opp_adjust_voltage(struct device *dev, unsigned long freq,
unsigned long u_volt, unsigned long u_volt_min,
unsigned long u_volt_max)
{
struct opp_table *opp_table;
struct dev_pm_opp *tmp_opp, *opp = ERR_PTR(-ENODEV);
int r = 0;
/* Find the opp_table */
opp_table = _find_opp_table(dev);
if (IS_ERR(opp_table)) {
r = PTR_ERR(opp_table);
dev_warn(dev, "%s: Device OPP not found (%d)\n", __func__, r);
return r;
}
mutex_lock(&opp_table->lock);
/* Do we have the frequency? */
list_for_each_entry(tmp_opp, &opp_table->opp_list, node) {
if (tmp_opp->rate == freq) {
opp = tmp_opp;
break;
}
}
if (IS_ERR(opp)) {
r = PTR_ERR(opp);
goto adjust_unlock;
}
/* Is update really needed? */
if (opp->supplies->u_volt == u_volt)
goto adjust_unlock;
opp->supplies->u_volt = u_volt;
opp->supplies->u_volt_min = u_volt_min;
opp->supplies->u_volt_max = u_volt_max;
dev_pm_opp_get(opp);
mutex_unlock(&opp_table->lock);
/* Notify the voltage change of the OPP */
blocking_notifier_call_chain(&opp_table->head, OPP_EVENT_ADJUST_VOLTAGE,
opp);
dev_pm_opp_put(opp);
goto adjust_put_table;
adjust_unlock:
mutex_unlock(&opp_table->lock);
adjust_put_table:
dev_pm_opp_put_opp_table(opp_table);
return r;
}
/**
* dev_pm_opp_enable() - Enable a specific OPP
* @dev: device for which we do this operation

10
drivers/soc/samsung/Kconfig
View File

@ -7,6 +7,16 @@ menuconfig SOC_SAMSUNG
if SOC_SAMSUNG
config EXYNOS_ASV
bool "Exynos Adaptive Supply Voltage support" if COMPILE_TEST
depends on (ARCH_EXYNOS && EXYNOS_CHIPID) || COMPILE_TEST
select EXYNOS_ASV_ARM if ARM && ARCH_EXYNOS
# There is no need to enable these drivers for ARMv8
config EXYNOS_ASV_ARM
bool "Exynos ASV ARMv7-specific driver extensions" if COMPILE_TEST
depends on EXYNOS_ASV
config EXYNOS_CHIPID
bool "Exynos Chipid controller driver" if COMPILE_TEST
depends on ARCH_EXYNOS || COMPILE_TEST

3
drivers/soc/samsung/Makefile
View File

@ -1,5 +1,8 @@
# SPDX-License-Identifier: GPL-2.0
obj-$(CONFIG_EXYNOS_ASV) += exynos-asv.o
obj-$(CONFIG_EXYNOS_ASV_ARM) += exynos5422-asv.o
obj-$(CONFIG_EXYNOS_CHIPID) += exynos-chipid.o
obj-$(CONFIG_EXYNOS_PMU) += exynos-pmu.o

177
drivers/soc/samsung/exynos-asv.c Normal file
View File

@ -0,0 +1,177 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 Samsung Electronics Co., Ltd.
* http://www.samsung.com/
* Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
*
* Samsung Exynos SoC Adaptive Supply Voltage support
*/
#include <linux/cpu.h>
#include <linux/device.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/mfd/syscon.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/pm_opp.h>
#include <linux/regmap.h>
#include <linux/soc/samsung/exynos-chipid.h>
#include "exynos-asv.h"
#include "exynos5422-asv.h"
#define MHZ 1000000U
static int exynos_asv_update_cpu_opps(struct exynos_asv *asv,
struct device *cpu)
{
struct exynos_asv_subsys *subsys = NULL;
struct dev_pm_opp *opp;
unsigned int opp_freq;
int i;
for (i = 0; i < ARRAY_SIZE(asv->subsys); i++) {
if (of_device_is_compatible(cpu->of_node,
asv->subsys[i].cpu_dt_compat)) {
subsys = &asv->subsys[i];
break;
}
}
if (!subsys)
return -EINVAL;
for (i = 0; i < subsys->table.num_rows; i++) {
unsigned int new_volt, volt;
int ret;
opp_freq = exynos_asv_opp_get_frequency(subsys, i);
opp = dev_pm_opp_find_freq_exact(cpu, opp_freq * MHZ, true);
if (IS_ERR(opp)) {
dev_info(asv->dev, "cpu%d opp%d, freq: %u missing\n",
cpu->id, i, opp_freq);
continue;
}
volt = dev_pm_opp_get_voltage(opp);
new_volt = asv->opp_get_voltage(subsys, i, volt);
dev_pm_opp_put(opp);
if (new_volt == volt)
continue;
ret = dev_pm_opp_adjust_voltage(cpu, opp_freq * MHZ,
new_volt, new_volt, new_volt);
if (ret < 0)
dev_err(asv->dev,
"Failed to adjust OPP %u Hz/%u uV for cpu%d\n",
opp_freq, new_volt, cpu->id);
else
dev_dbg(asv->dev,
"Adjusted OPP %u Hz/%u -> %u uV, cpu%d\n",
opp_freq, volt, new_volt, cpu->id);
}
return 0;
}
static int exynos_asv_update_opps(struct exynos_asv *asv)
{
struct opp_table *last_opp_table = NULL;
struct device *cpu;
int ret, cpuid;
for_each_possible_cpu(cpuid) {
struct opp_table *opp_table;
cpu = get_cpu_device(cpuid);
if (!cpu)
continue;
opp_table = dev_pm_opp_get_opp_table(cpu);
if (IS_ERR_OR_NULL(opp_table))
continue;
if (!last_opp_table || opp_table != last_opp_table) {
last_opp_table = opp_table;
ret = exynos_asv_update_cpu_opps(asv, cpu);
if (ret < 0)
dev_err(asv->dev, "Couldn't udate OPPs for cpu%d\n",
cpuid);
}
dev_pm_opp_put_opp_table(opp_table);
}
return 0;
}
static int exynos_asv_probe(struct platform_device *pdev)
{
int (*probe_func)(struct exynos_asv *asv);
struct exynos_asv *asv;
struct device *cpu_dev;
u32 product_id = 0;
int ret, i;
cpu_dev = get_cpu_device(0);
ret = dev_pm_opp_get_opp_count(cpu_dev);
if (ret < 0)
return -EPROBE_DEFER;
asv = devm_kzalloc(&pdev->dev, sizeof(*asv), GFP_KERNEL);
if (!asv)
return -ENOMEM;
asv->chipid_regmap = device_node_to_regmap(pdev->dev.of_node);
if (IS_ERR(asv->chipid_regmap)) {
dev_err(&pdev->dev, "Could not find syscon regmap\n");
return PTR_ERR(asv->chipid_regmap);
}
regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_PRO_ID, &product_id);
switch (product_id & EXYNOS_MASK) {
case 0xE5422000:
probe_func = exynos5422_asv_init;
break;
default:
return -ENODEV;
}
ret = of_property_read_u32(pdev->dev.of_node, "samsung,asv-bin",
&asv->of_bin);
if (ret < 0)
asv->of_bin = -EINVAL;
asv->dev = &pdev->dev;
dev_set_drvdata(&pdev->dev, asv);
for (i = 0; i < ARRAY_SIZE(asv->subsys); i++)
asv->subsys[i].asv = asv;
ret = probe_func(asv);
if (ret < 0)
return ret;
return exynos_asv_update_opps(asv);
}
static const struct of_device_id exynos_asv_of_device_ids[] = {
{ .compatible = "samsung,exynos4210-chipid" },
{}
};
static struct platform_driver exynos_asv_driver = {
.driver = {
.name = "exynos-asv",
.of_match_table = exynos_asv_of_device_ids,
},
.probe = exynos_asv_probe,
};
module_platform_driver(exynos_asv_driver);

71
drivers/soc/samsung/exynos-asv.h Normal file
View File

@ -0,0 +1,71 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 Samsung Electronics Co., Ltd.
* http://www.samsung.com/
* Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
*
* Samsung Exynos SoC Adaptive Supply Voltage support
*/
#ifndef __LINUX_SOC_EXYNOS_ASV_H
#define __LINUX_SOC_EXYNOS_ASV_H
struct regmap;
/* HPM, IDS values to select target group */
struct asv_limit_entry {
unsigned int hpm;
unsigned int ids;
};
struct exynos_asv_table {
unsigned int num_rows;
unsigned int num_cols;
u32 *buf;
};
struct exynos_asv_subsys {
struct exynos_asv *asv;
const char *cpu_dt_compat;
int id;
struct exynos_asv_table table;
unsigned int base_volt;
unsigned int offset_volt_h;
unsigned int offset_volt_l;
};
struct exynos_asv {
struct device *dev;
struct regmap *chipid_regmap;
struct exynos_asv_subsys subsys[2];
int (*opp_get_voltage)(const struct exynos_asv_subsys *subs,
int level, unsigned int voltage);
unsigned int group;
unsigned int table;
/* True if SG fields from PKG_ID register should be used */
bool use_sg;
/* ASV bin read from DT */
int of_bin;
};
static inline u32 __asv_get_table_entry(const struct exynos_asv_table *table,
unsigned int row, unsigned int col)
{
return table->buf[row * (table->num_cols) + col];
}
static inline u32 exynos_asv_opp_get_voltage(const struct exynos_asv_subsys *subsys,
unsigned int level, unsigned int group)
{
return __asv_get_table_entry(&subsys->table, level, group + 1);
}
static inline u32 exynos_asv_opp_get_frequency(const struct exynos_asv_subsys *subsys,
unsigned int level)
{
return __asv_get_table_entry(&subsys->table, level, 0);
}
#endif /* __LINUX_SOC_EXYNOS_ASV_H */

12
drivers/soc/samsung/exynos-chipid.c
View File

@ -45,17 +45,25 @@ static const char * __init product_id_to_soc_id(unsigned int product_id)
return NULL;
}
int __init exynos_chipid_early_init(void)
static int __init exynos_chipid_early_init(void)
{
struct soc_device_attribute *soc_dev_attr;
struct soc_device *soc_dev;
struct device_node *root;
struct device_node *syscon;
struct regmap *regmap;
u32 product_id;
u32 revision;
int ret;
regmap = syscon_regmap_lookup_by_compatible("samsung,exynos4210-chipid");
syscon = of_find_compatible_node(NULL, NULL,
"samsung,exynos4210-chipid");
if (!syscon)
return ENODEV;
regmap = device_node_to_regmap(syscon);
of_node_put(syscon);
if (IS_ERR(regmap))
return PTR_ERR(regmap);

505
drivers/soc/samsung/exynos5422-asv.c Normal file
View File

@ -0,0 +1,505 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 Samsung Electronics Co., Ltd.
* http://www.samsung.com/
*
* Samsung Exynos 5422 SoC Adaptive Supply Voltage support
*/
#include <linux/bitrev.h>
#include <linux/errno.h>
#include <linux/regmap.h>
#include <linux/soc/samsung/exynos-chipid.h>
#include <linux/slab.h>
#include "exynos-asv.h"
#include "exynos5422-asv.h"
#define ASV_GROUPS_NUM 14
#define ASV_ARM_DVFS_NUM 20
#define ASV_ARM_BIN2_DVFS_NUM 17
#define ASV_KFC_DVFS_NUM 14
#define ASV_KFC_BIN2_DVFS_NUM 12
/*
* This array is a set of 4 ASV data tables, first column of each ASV table
* contains frequency value in MHz and subsequent columns contain the CPU
* cluster's supply voltage values in uV.
* In order to create a set of OPPs for specific SoC revision one of the voltage
* columns (1...14) from one of the tables (0...3) is selected during
* initialization. There are separate ASV tables for the big (ARM) and little
* (KFC) CPU cluster. Only OPPs which are already defined in devicetree
* will be updated.
*/
static const u32 asv_arm_table[][ASV_ARM_DVFS_NUM][ASV_GROUPS_NUM + 1] = {
{
/* ARM 0, 1 */
{ 2100, 1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
{ 2000, 1312500, 1312500, 1300000, 1287500, 1275000, 1262500, 1250000,
1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1900, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500, 1175000,
1162500, 1150000, 1162500, 1150000, 1137500, 1125000, 1112500 },
{ 1800, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
1112500, 1100000, 1112500, 1100000, 1087500, 1075000, 1062500 },
{ 1700, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
1075000, 1062500, 1075000, 1062500, 1050000, 1037500, 1025000 },
{ 1600, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
1037500, 1025000, 1037500, 1025000, 1012500, 1000000, 987500 },
{ 1500, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
1000000, 987500, 1000000, 987500, 975000, 962500, 950000 },
{ 1400, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
975000, 962500, 975000, 962500, 950000, 937500, 925000 },
{ 1300, 1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000,
962500, 950000, 962500, 950000, 937500, 925000, 912500 },
{ 1200, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 937500, 925000, 912500, 900000, 900000 },
{ 1100, 1000000, 987500, 975000, 962500, 950000, 937500, 925000,
912500, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 1000, 975000, 962500, 950000, 937500, 925000, 912500, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 900, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 800, 925000, 912500, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 700, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* ARM 2 */
{ 2100, 1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
{ 2000, 1312500, 1312500, 1312500, 1300000, 1275000, 1262500, 1250000,
1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1900, 1262500, 1250000, 1250000, 1237500, 1212500, 1200000, 1187500,
1175000, 1162500, 1175000, 1162500, 1150000, 1137500, 1125000 },
{ 1800, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500,
1125000, 1112500, 1125000, 1112500, 1100000, 1087500, 1075000 },
{ 1700, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
1087500, 1075000, 1087500, 1075000, 1062500, 1050000, 1037500 },
{ 1600, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
1050000, 1037500, 1050000, 1037500, 1025000, 1012500, 1000000 },
{ 1500, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 1012500, 1000000, 987500, 975000, 962500 },
{ 1400, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000,
987500, 975000, 987500, 975000, 962500, 950000, 937500 },
{ 1300, 1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000,
962500, 950000, 962500, 950000, 937500, 925000, 912500 },
{ 1200, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 937500, 925000, 912500, 900000, 900000 },
{ 1100, 1000000, 987500, 975000, 962500, 950000, 937500, 925000,
912500, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 1000, 975000, 962500, 950000, 937500, 925000, 912500, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 900, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 800, 925000, 912500, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 700, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* ARM 3 */
{ 2100, 1362500, 1362500, 1350000, 1337500, 1325000, 1312500, 1300000,
1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000 },
{ 2000, 1312500, 1312500, 1300000, 1287500, 1275000, 1262500, 1250000,
1237500, 1225000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1900, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500,
1175000, 1162500, 1175000, 1162500, 1150000, 1137500, 1125000 },
{ 1800, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500,
1125000, 1112500, 1125000, 1112500, 1100000, 1087500, 1075000 },
{ 1700, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
1087500, 1075000, 1087500, 1075000, 1062500, 1050000, 1037500 },
{ 1600, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
1050000, 1037500, 1050000, 1037500, 1025000, 1012500, 1000000 },
{ 1500, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 1012500, 1000000, 987500, 975000, 962500 },
{ 1400, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000,
987500, 975000, 987500, 975000, 962500, 950000, 937500 },
{ 1300, 1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000,
962500, 950000, 962500, 950000, 937500, 925000, 912500 },
{ 1200, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 937500, 925000, 912500, 900000, 900000 },
{ 1100, 1000000, 987500, 975000, 962500, 950000, 937500, 925000,
912500, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 1000, 975000, 962500, 950000, 937500, 925000, 912500, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 900, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 800, 925000, 912500, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 700, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* ARM bin 2 */
{ 1800, 1237500, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500,
1150000, 1137500, 1150000, 1137500, 1125000, 1112500, 1100000 },
{ 1700, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
1112500, 1100000, 1112500, 1100000, 1087500, 1075000, 1062500 },
{ 1600, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
1075000, 1062500, 1075000, 1062500, 1050000, 1037500, 1025000 },
{ 1500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
1037500, 1025000, 1037500, 1025000, 1012500, 1000000, 987500 },
{ 1400, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 1012500, 1000000, 987500, 975000, 962500 },
{ 1300, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
1000000, 987500, 1000000, 987500, 975000, 962500, 950000 },
{ 1200, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
975000, 962500, 975000, 962500, 950000, 937500, 925000 },
{ 1100, 1037500, 1025000, 1012500, 1000000, 987500, 975000, 962500,
950000, 937500, 950000, 937500, 925000, 912500, 900000 },
{ 1000, 1012500, 1000000, 987500, 975000, 962500, 950000, 937500,
925000, 912500, 925000, 912500, 900000, 900000, 900000 },
{ 900, 987500, 975000, 962500, 950000, 937500, 925000, 912500,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 800, 962500, 950000, 937500, 925000, 912500, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 700, 937500, 925000, 912500, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}
};
static const u32 asv_kfc_table[][ASV_KFC_DVFS_NUM][ASV_GROUPS_NUM + 1] = {
{
/* KFC 0, 1 */
{ 1500000, 1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1400000, 1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
{ 1300000, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
{ 1200000, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
{ 1100000, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000 },
{ 1000000, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 987500, 975000, 962500, 950000, 937500 },
{ 900000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
975000, 962500, 950000, 937500, 925000, 912500, 900000 },
{ 800000, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 912500, 900000, 900000, 900000, 900000 },
{ 700000, 987500, 975000, 962500, 950000, 937500, 925000, 912500,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600000, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500000, 912500, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400000, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300000, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200000, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* KFC 2 */
{ 1500, 1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1400, 1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
{ 1300, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
{ 1200, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
{ 1100, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000 },
{ 1000, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 987500, 975000, 962500, 950000, 937500 },
{ 900, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
975000, 962500, 950000, 937500, 925000, 912500, 900000 },
{ 800, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 912500, 900000, 900000, 900000, 900000 },
{ 700, 987500, 975000, 962500, 950000, 937500, 925000, 912500,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 912500, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* KFC 3 */
{ 1500, 1300000, 1300000, 1300000, 1287500, 1287500, 1287500, 1275000,
1262500, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500 },
{ 1400, 1275000, 1262500, 1250000, 1237500, 1225000, 1212500, 1200000,
1187500, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500 },
{ 1300, 1225000, 1212500, 1200000, 1187500, 1175000, 1162500, 1150000,
1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500 },
{ 1200, 1175000, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000,
1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500 },
{ 1100, 1137500, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500,
1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000 },
{ 1000, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000,
1012500, 1000000, 987500, 975000, 962500, 950000, 937500 },
{ 900, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000, 987500,
975000, 962500, 950000, 937500, 925000, 912500, 900000 },
{ 800, 1025000, 1012500, 1000000, 987500, 975000, 962500, 950000,
937500, 925000, 912500, 900000, 900000, 900000, 900000 },
{ 700, 987500, 975000, 962500, 950000, 937500, 925000, 912500,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 600, 950000, 937500, 925000, 912500, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 912500, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}, {
/* KFC bin 2 */
{ 1300, 1250000, 1237500, 1225000, 1212500, 1200000, 1187500, 1175000,
1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500 },
{ 1200, 1200000, 1187500, 1175000, 1162500, 1150000, 1137500, 1125000,
1112500, 1100000, 1087500, 1075000, 1062500, 1050000, 1037500 },
{ 1100, 1162500, 1150000, 1137500, 1125000, 1112500, 1100000, 1087500,
1075000, 1062500, 1050000, 1037500, 1025000, 1012500, 1000000 },
{ 1000, 1125000, 1112500, 1100000, 1087500, 1075000, 1062500, 1050000,
1037500, 1025000, 1012500, 1000000, 987500, 975000, 962500 },
{ 900, 1087500, 1075000, 1062500, 1050000, 1037500, 1025000, 1012500,
1000000, 987500, 975000, 962500, 950000, 937500, 925000 },
{ 800, 1050000, 1037500, 1025000, 1012500, 1000000, 987500, 975000,
962500, 950000, 937500, 925000, 912500, 900000, 900000 },
{ 700, 1012500, 1000000, 987500, 975000, 962500, 950000, 937500,
925000, 912500, 900000, 900000, 900000, 900000, 900000 },
{ 600, 975000, 962500, 950000, 937500, 925000, 912500, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 500, 937500, 925000, 912500, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 400, 925000, 912500, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 300, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
{ 200, 900000, 900000, 900000, 900000, 900000, 900000, 900000,
900000, 900000, 900000, 900000, 900000, 900000, 900000 },
}
};
static const struct asv_limit_entry __asv_limits[ASV_GROUPS_NUM] = {
{ 13, 55 },
{ 21, 65 },
{ 25, 69 },
{ 30, 72 },
{ 36, 74 },
{ 43, 76 },
{ 51, 78 },
{ 65, 80 },
{ 81, 82 },
{ 98, 84 },
{ 119, 87 },
{ 135, 89 },
{ 150, 92 },
{ 999, 999 },
};
static int exynos5422_asv_get_group(struct exynos_asv *asv)
{
unsigned int pkgid_reg, auxi_reg;
int hpm, ids, i;
regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_PKG_ID, &pkgid_reg);
regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_AUX_INFO, &auxi_reg);
if (asv->use_sg) {
u32 sga = (pkgid_reg >> EXYNOS5422_SG_A_OFFSET) &
EXYNOS5422_SG_A_MASK;
u32 sgb = (pkgid_reg >> EXYNOS5422_SG_B_OFFSET) &
EXYNOS5422_SG_B_MASK;
if ((pkgid_reg >> EXYNOS5422_SG_BSIGN_OFFSET) &
EXYNOS5422_SG_BSIGN_MASK)
return sga + sgb;
else
return sga - sgb;
}
hpm = (auxi_reg >> EXYNOS5422_TMCB_OFFSET) & EXYNOS5422_TMCB_MASK;
ids = (pkgid_reg >> EXYNOS5422_IDS_OFFSET) & EXYNOS5422_IDS_MASK;
for (i = 0; i < ASV_GROUPS_NUM; i++) {
if (ids <= __asv_limits[i].ids)
break;
if (hpm <= __asv_limits[i].hpm)
break;
}
if (i < ASV_GROUPS_NUM)
return i;
return 0;
}
static int __asv_offset_voltage(unsigned int index)
{
switch (index) {
case 1:
return 12500;
case 2:
return 50000;
case 3:
return 25000;
default:
return 0;
};
}
static void exynos5422_asv_offset_voltage_setup(struct exynos_asv *asv)
{
struct exynos_asv_subsys *subsys;
unsigned int reg, value;
regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_AUX_INFO, &reg);
/* ARM offset voltage setup */
subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_ARM];
subsys->base_volt = 1000000;
value = (reg >> EXYNOS5422_ARM_UP_OFFSET) & EXYNOS5422_ARM_UP_MASK;
subsys->offset_volt_h = __asv_offset_voltage(value);
value = (reg >> EXYNOS5422_ARM_DN_OFFSET) & EXYNOS5422_ARM_DN_MASK;
subsys->offset_volt_l = __asv_offset_voltage(value);
/* KFC offset voltage setup */
subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_KFC];
subsys->base_volt = 1000000;
value = (reg >> EXYNOS5422_KFC_UP_OFFSET) & EXYNOS5422_KFC_UP_MASK;
subsys->offset_volt_h = __asv_offset_voltage(value);
value = (reg >> EXYNOS5422_KFC_DN_OFFSET) & EXYNOS5422_KFC_DN_MASK;
subsys->offset_volt_l = __asv_offset_voltage(value);
}
static int exynos5422_asv_opp_get_voltage(const struct exynos_asv_subsys *subsys,
int level, unsigned int volt)
{
unsigned int asv_volt;
if (level >= subsys->table.num_rows)
return volt;
asv_volt = exynos_asv_opp_get_voltage(subsys, level,
subsys->asv->group);
if (volt > subsys->base_volt)
asv_volt += subsys->offset_volt_h;
else
asv_volt += subsys->offset_volt_l;
return asv_volt;
}
static unsigned int exynos5422_asv_parse_table(unsigned int pkg_id)
{
return (pkg_id >> EXYNOS5422_TABLE_OFFSET) & EXYNOS5422_TABLE_MASK;
}
static bool exynos5422_asv_parse_bin2(unsigned int pkg_id)
{
return (pkg_id >> EXYNOS5422_BIN2_OFFSET) & EXYNOS5422_BIN2_MASK;
}
static bool exynos5422_asv_parse_sg(unsigned int pkg_id)
{
return (pkg_id >> EXYNOS5422_USESG_OFFSET) & EXYNOS5422_USESG_MASK;
}
int exynos5422_asv_init(struct exynos_asv *asv)
{
struct exynos_asv_subsys *subsys;
unsigned int table_index;
unsigned int pkg_id;
bool bin2;
regmap_read(asv->chipid_regmap, EXYNOS_CHIPID_REG_PKG_ID, &pkg_id);
if (asv->of_bin == 2) {
bin2 = true;
asv->use_sg = false;
} else {
asv->use_sg = exynos5422_asv_parse_sg(pkg_id);
bin2 = exynos5422_asv_parse_bin2(pkg_id);
}
asv->group = exynos5422_asv_get_group(asv);
asv->table = exynos5422_asv_parse_table(pkg_id);
exynos5422_asv_offset_voltage_setup(asv);
if (bin2) {
table_index = 3;
} else {
if (asv->table == 2 || asv->table == 3)
table_index = asv->table - 1;
else
table_index = 0;
}
subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_ARM];
subsys->cpu_dt_compat = "arm,cortex-a15";
if (bin2)
subsys->table.num_rows = ASV_ARM_BIN2_DVFS_NUM;
else
subsys->table.num_rows = ASV_ARM_DVFS_NUM;
subsys->table.num_cols = ASV_GROUPS_NUM + 1;
subsys->table.buf = (u32 *)asv_arm_table[table_index];
subsys = &asv->subsys[EXYNOS_ASV_SUBSYS_ID_KFC];
subsys->cpu_dt_compat = "arm,cortex-a7";
if (bin2)
subsys->table.num_rows = ASV_KFC_BIN2_DVFS_NUM;
else
subsys->table.num_rows = ASV_KFC_DVFS_NUM;
subsys->table.num_cols = ASV_GROUPS_NUM + 1;
subsys->table.buf = (u32 *)asv_kfc_table[table_index];
asv->opp_get_voltage = exynos5422_asv_opp_get_voltage;
return 0;
}

31
drivers/soc/samsung/exynos5422-asv.h Normal file
View File

@ -0,0 +1,31 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 Samsung Electronics Co., Ltd.
* http://www.samsung.com/
*
* Samsung Exynos 5422 SoC Adaptive Supply Voltage support
*/
#ifndef __LINUX_SOC_EXYNOS5422_ASV_H
#define __LINUX_SOC_EXYNOS5422_ASV_H
#include <linux/errno.h>
enum {
EXYNOS_ASV_SUBSYS_ID_ARM,
EXYNOS_ASV_SUBSYS_ID_KFC,
EXYNOS_ASV_SUBSYS_ID_MAX
};
struct exynos_asv;
#ifdef CONFIG_EXYNOS_ASV_ARM
int exynos5422_asv_init(struct exynos_asv *asv);
#else
static inline int exynos5422_asv_init(struct exynos_asv *asv)
{
return -ENOTSUPP;
}
#endif
#endif /* __LINUX_SOC_EXYNOS5422_ASV_H */

13
include/linux/pm_opp.h
View File

@ -22,6 +22,7 @@ struct opp_table;
enum dev_pm_opp_event {
OPP_EVENT_ADD, OPP_EVENT_REMOVE, OPP_EVENT_ENABLE, OPP_EVENT_DISABLE,
OPP_EVENT_ADJUST_VOLTAGE,
};
/**
@ -113,6 +114,10 @@ int dev_pm_opp_add(struct device *dev, unsigned long freq,
void dev_pm_opp_remove(struct device *dev, unsigned long freq);
void dev_pm_opp_remove_all_dynamic(struct device *dev);
int dev_pm_opp_adjust_voltage(struct device *dev, unsigned long freq,
unsigned long u_volt, unsigned long u_volt_min,
unsigned long u_volt_max);
int dev_pm_opp_enable(struct device *dev, unsigned long freq);
int dev_pm_opp_disable(struct device *dev, unsigned long freq);
@ -242,6 +247,14 @@ static inline void dev_pm_opp_remove_all_dynamic(struct device *dev)
{
}
static inline int
dev_pm_opp_adjust_voltage(struct device *dev, unsigned long freq,
unsigned long u_volt, unsigned long u_volt_min,
unsigned long u_volt_max)
{
return 0;
}
static inline int dev_pm_opp_enable(struct device *dev, unsigned long freq)
{
return 0;