Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/arch/arm/nvidia Split cpufreq driver out into a separate...
details: https://anonhg.NetBSD.org/src/rev/e1dcf8789775
branches: trunk
changeset: 823455:e1dcf8789775
user: jmcneill <jmcneill%NetBSD.org@localhost>
date: Sun Apr 23 12:31:38 2017 +0000
description:
Split cpufreq driver out into a separate module.
diffstat:
sys/arch/arm/nvidia/files.tegra | 5 +-
sys/arch/arm/nvidia/soc_tegra124.c | 259 +-------------------------------
sys/arch/arm/nvidia/tegra124_cpu.c | 301 +++++++++++++++++++++++++++++++++++++
3 files changed, 308 insertions(+), 257 deletions(-)
diffs (truncated from 613 to 300 lines):
diff -r facbe4759bff -r e1dcf8789775 sys/arch/arm/nvidia/files.tegra
--- a/sys/arch/arm/nvidia/files.tegra Sun Apr 23 11:38:53 2017 +0000
+++ b/sys/arch/arm/nvidia/files.tegra Sun Apr 23 12:31:38 2017 +0000
@@ -1,4 +1,4 @@
-# $NetBSD: files.tegra,v 1.32 2017/04/22 23:53:24 jmcneill Exp $
+# $NetBSD: files.tegra,v 1.33 2017/04/23 12:31:38 jmcneill Exp $
#
# Configuration info for NVIDIA Tegra ARM Peripherals
#
@@ -22,9 +22,10 @@
file arch/arm/nvidia/tegra_cpufreq.c
# Tegra T124 (32-bit K1) support
+file arch/arm/nvidia/soc_tegra124.c soc_tegra124
device tegra124cpu
attach tegra124cpu at fdt with tegra124_cpu
-file arch/arm/nvidia/soc_tegra124.c soc_tegra124 | tegra124_cpu
+file arch/arm/nvidia/tegra124_cpu.c tegra124_cpu
# Interrupt controller
device tegralic
diff -r facbe4759bff -r e1dcf8789775 sys/arch/arm/nvidia/soc_tegra124.c
--- a/sys/arch/arm/nvidia/soc_tegra124.c Sun Apr 23 11:38:53 2017 +0000
+++ b/sys/arch/arm/nvidia/soc_tegra124.c Sun Apr 23 12:31:38 2017 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: soc_tegra124.c,v 1.16 2017/04/22 23:53:24 jmcneill Exp $ */
+/* $NetBSD: soc_tegra124.c,v 1.17 2017/04/23 12:31:38 jmcneill Exp $ */
/*-
* Copyright (c) 2015 Jared D. McNeill <jmcneill%invisible.ca@localhost>
@@ -30,7 +30,7 @@
#include "opt_multiprocessor.h"
#include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: soc_tegra124.c,v 1.16 2017/04/22 23:53:24 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: soc_tegra124.c,v 1.17 2017/04/23 12:31:38 jmcneill Exp $");
#include <sys/param.h>
#include <sys/bus.h>
@@ -49,258 +49,6 @@
#define EVP_RESET_VECTOR_0_REG 0x100
-#define FUSE_SKU_INFO_REG 0x010
-#define FUSE_CPU_SPEEDO_0_REG 0x014
-#define FUSE_CPU_IDDQ_REG 0x018
-#define FUSE_FT_REV_REG 0x028
-#define FUSE_CPU_SPEEDO_1_REG 0x02c
-#define FUSE_CPU_SPEEDO_2_REG 0x030
-#define FUSE_SOC_SPEEDO_0_REG 0x034
-#define FUSE_SOC_SPEEDO_1_REG 0x038
-#define FUSE_SOC_SPEEDO_2_REG 0x03c
-#define FUSE_SOC_IDDQ_REG 0x040
-#define FUSE_GPU_IDDQ_REG 0x128
-
-static void tegra124_speedo_init(void);
-static int tegra124_speedo_init_ids(uint32_t);
-static bool tegra124_speedo_rate_ok(u_int);
-
-static u_int tegra124_cpufreq_set_rate(u_int);
-static u_int tegra124_cpufreq_get_rate(void);
-static size_t tegra124_cpufreq_get_available(u_int *, size_t);
-
-static int tegra124_cpu_match(device_t, cfdata_t, void *);
-static void tegra124_cpu_attach(device_t, device_t, void *);
-static void tegra124_cpu_init_cpufreq(device_t);
-
-CFATTACH_DECL_NEW(tegra124_cpu, 0, tegra124_cpu_match, tegra124_cpu_attach,
- NULL, NULL);
-
-static const struct tegra_cpufreq_func tegra124_cpufreq_func = {
- .set_rate = tegra124_cpufreq_set_rate,
- .get_rate = tegra124_cpufreq_get_rate,
- .get_available = tegra124_cpufreq_get_available,
-};
-
-static struct tegra124_cpufreq_rate {
- u_int rate;
- u_int divm;
- u_int divn;
- u_int divp;
- u_int uvol;
-} tegra124_cpufreq_rates[] = {
- { 2316, 1, 193, 0, 1400000 },
- { 2100, 1, 175, 0, 1400000 },
- { 1896, 1, 158, 0, 1400000 },
- { 1692, 1, 141, 0, 1400000 },
- { 1500, 1, 125, 0, 1400000 },
- { 1296, 1, 108, 0, 1400000 },
- { 1092, 1, 91, 0, 1400000 },
- { 900, 1, 75, 0, 1400000 },
- { 696, 1, 58, 0, 1400000 }
-};
-
-static const u_int tegra124_cpufreq_max[] = {
- 2014,
- 2320,
- 2116,
- 2524
-};
-
-static struct tegra124_speedo {
- u_int cpu_speedo_id;
- u_int soc_speedo_id;
- u_int gpu_speedo_id;
-} tegra124_speedo = {
- .cpu_speedo_id = 0,
- .soc_speedo_id = 0,
- .gpu_speedo_id = 0
-};
-
-static struct clk *tegra124_clk_pllx = NULL;
-static struct fdtbus_regulator *tegra124_reg_vddcpu = NULL;
-
-static int
-tegra124_cpu_match(device_t parent, cfdata_t cf, void *aux)
-{
- const char * const compatible[] = { "nvidia,tegra124", NULL };
- struct fdt_attach_args *faa = aux;
-
- if (OF_finddevice("/cpus") != faa->faa_phandle)
- return 0;
-
- return of_match_compatible(OF_finddevice("/"), compatible);
-}
-
-static void
-tegra124_cpu_attach(device_t parent, device_t self, void *aux)
-{
- aprint_naive("\n");
- aprint_normal(": CPU complex\n");
-
- config_defer(self, tegra124_cpu_init_cpufreq);
-}
-
-static void
-tegra124_cpu_init_cpufreq(device_t dev)
-{
- tegra124_speedo_init();
-
- int cpu_node = OF_finddevice("/cpus/cpu@0");
- if (cpu_node != -1) {
- tegra124_clk_pllx = fdtbus_clock_get(cpu_node, "pll_x");
- tegra124_reg_vddcpu = fdtbus_regulator_acquire(cpu_node,
- "vdd-cpu-supply");
- }
- if (tegra124_clk_pllx == NULL) {
- aprint_error_dev(dev, "couldn't find clock pll_x\n");
- return;
- }
- if (tegra124_reg_vddcpu == NULL) {
- aprint_error_dev(dev, "couldn't find voltage regulator\n");
- return;
- }
-
- tegra_cpufreq_register(&tegra124_cpufreq_func);
-}
-
-static void
-tegra124_speedo_init(void)
-{
- uint32_t sku_id;
-
- sku_id = tegra_fuse_read(FUSE_SKU_INFO_REG);
- tegra124_speedo_init_ids(sku_id);
-}
-
-static int
-tegra124_speedo_init_ids(uint32_t sku_id)
-{
- int threshold = 0;
-
- switch (sku_id) {
- case 0x00:
- case 0x0f:
- case 0x23:
- break; /* use default */
- case 0x83:
- tegra124_speedo.cpu_speedo_id = 2;
- break;
- case 0x1f:
- case 0x87:
- case 0x27:
- tegra124_speedo.cpu_speedo_id = 2;
- tegra124_speedo.soc_speedo_id = 0;
- tegra124_speedo.gpu_speedo_id = 1;
- break;
- case 0x81:
- case 0x21:
- case 0x07:
- tegra124_speedo.cpu_speedo_id = 1;
- tegra124_speedo.soc_speedo_id = 1;
- tegra124_speedo.gpu_speedo_id = 1;
- threshold = 1;
- break;
- case 0x49:
- case 0x4a:
- case 0x48:
- tegra124_speedo.cpu_speedo_id = 4;
- tegra124_speedo.soc_speedo_id = 2;
- tegra124_speedo.gpu_speedo_id = 3;
- threshold = 1;
- break;
- default:
- aprint_error("tegra124: unknown SKU ID %#x\n", sku_id);
- break; /* use default */
- }
-
- return threshold;
-}
-
-static bool
-tegra124_speedo_rate_ok(u_int rate)
-{
- u_int tbl = 0;
-
- if (tegra124_speedo.cpu_speedo_id < __arraycount(tegra124_cpufreq_max))
- tbl = tegra124_speedo.cpu_speedo_id;
-
- return rate <= tegra124_cpufreq_max[tbl];
-}
-
-
-static u_int
-tegra124_cpufreq_set_rate(u_int rate)
-{
- const u_int nrates = __arraycount(tegra124_cpufreq_rates);
- const struct tegra124_cpufreq_rate *r = NULL;
- CPU_INFO_ITERATOR cii;
- struct cpu_info *ci;
- u_int cur_uvol;
- int error;
-
- if (tegra124_speedo_rate_ok(rate) == false)
- return EINVAL;
-
- for (int i = 0; i < nrates; i++) {
- if (tegra124_cpufreq_rates[i].rate == rate) {
- r = &tegra124_cpufreq_rates[i];
- break;
- }
- }
- if (r == NULL)
- return EINVAL;
-
- error = fdtbus_regulator_get_voltage(tegra124_reg_vddcpu, &cur_uvol);
- if (error != 0)
- return error;
-
- if (cur_uvol < r->uvol) {
- error = fdtbus_regulator_set_voltage(tegra124_reg_vddcpu,
- r->uvol, r->uvol);
- if (error != 0)
- return error;
- }
-
- error = clk_set_rate(tegra124_clk_pllx, r->rate * 1000000);
- if (error == 0) {
- rate = tegra124_cpufreq_get_rate();
- for (CPU_INFO_FOREACH(cii, ci)) {
- ci->ci_data.cpu_cc_freq = rate * 1000000;
- }
- }
-
- if (cur_uvol > r->uvol) {
- (void)fdtbus_regulator_set_voltage(tegra124_reg_vddcpu,
- r->uvol, r->uvol);
- }
-
- return error;
-}
-
-static u_int
-tegra124_cpufreq_get_rate(void)
-{
- return clk_get_rate(tegra124_clk_pllx) / 1000000;
-}
-
-static size_t
-tegra124_cpufreq_get_available(u_int *pavail, size_t maxavail)
-{
- const u_int nrates = __arraycount(tegra124_cpufreq_rates);
- u_int n, cnt;
-
- KASSERT(nrates <= maxavail);
-
- for (n = 0, cnt = 0; n < nrates; n++) {
- if (tegra124_speedo_rate_ok(tegra124_cpufreq_rates[n].rate)) {
- pavail[cnt++] = tegra124_cpufreq_rates[n].rate;
- }
- }
-
- return cnt;
-}
-
void
tegra124_mpinit(void)
{
@@ -315,7 +63,8 @@
arm_cpu_max = 1 + __SHIFTOUT(armreg_l2ctrl_read(), L2CTRL_NUMCPU);
Home |
Main Index |
Thread Index |
Old Index