1*2ab22fd0Sjmcneill /* $NetBSD: tegra_cpufreq.c,v 1.5 2017/04/22 23:53:24 jmcneill Exp $ */
218da347dSjmcneill
318da347dSjmcneill /*-
418da347dSjmcneill * Copyright (c) 2015 Jared D. McNeill <jmcneill@invisible.ca>
518da347dSjmcneill * All rights reserved.
618da347dSjmcneill *
718da347dSjmcneill * Redistribution and use in source and binary forms, with or without
818da347dSjmcneill * modification, are permitted provided that the following conditions
918da347dSjmcneill * are met:
1018da347dSjmcneill * 1. Redistributions of source code must retain the above copyright
1118da347dSjmcneill * notice, this list of conditions and the following disclaimer.
1218da347dSjmcneill * 2. Redistributions in binary form must reproduce the above copyright
1318da347dSjmcneill * notice, this list of conditions and the following disclaimer in the
1418da347dSjmcneill * documentation and/or other materials provided with the distribution.
1518da347dSjmcneill *
1618da347dSjmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
1718da347dSjmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1818da347dSjmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
1918da347dSjmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
2018da347dSjmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
2118da347dSjmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
2218da347dSjmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
2318da347dSjmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
2418da347dSjmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2518da347dSjmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2618da347dSjmcneill * SUCH DAMAGE.
2718da347dSjmcneill */
2818da347dSjmcneill
2918da347dSjmcneill #include "locators.h"
3018da347dSjmcneill
3118da347dSjmcneill #include <sys/cdefs.h>
32*2ab22fd0Sjmcneill __KERNEL_RCSID(0, "$NetBSD: tegra_cpufreq.c,v 1.5 2017/04/22 23:53:24 jmcneill Exp $");
3318da347dSjmcneill
3418da347dSjmcneill #include <sys/param.h>
3518da347dSjmcneill #include <sys/bus.h>
3618da347dSjmcneill #include <sys/device.h>
3718da347dSjmcneill #include <sys/intr.h>
3818da347dSjmcneill #include <sys/systm.h>
3918da347dSjmcneill #include <sys/kernel.h>
4018da347dSjmcneill #include <sys/atomic.h>
4118da347dSjmcneill #include <sys/kmem.h>
4218da347dSjmcneill #include <sys/sysctl.h>
4318da347dSjmcneill
4418da347dSjmcneill #include <arm/nvidia/tegra_var.h>
4518da347dSjmcneill
4618da347dSjmcneill static u_int cpufreq_busy;
4718da347dSjmcneill static struct sysctllog *cpufreq_log;
4818da347dSjmcneill static int cpufreq_node_target, cpufreq_node_current, cpufreq_node_available;
4918da347dSjmcneill
5018da347dSjmcneill static const struct tegra_cpufreq_func *cpufreq_func = NULL;
5118da347dSjmcneill
5218da347dSjmcneill static int tegra_cpufreq_freq_helper(SYSCTLFN_PROTO);
5318da347dSjmcneill static char tegra_cpufreq_available[TEGRA_CPUFREQ_MAX * 5];
5418da347dSjmcneill
5518da347dSjmcneill #define cpufreq_set_rate cpufreq_func->set_rate
5618da347dSjmcneill #define cpufreq_get_rate cpufreq_func->get_rate
5718da347dSjmcneill #define cpufreq_get_available cpufreq_func->get_available
5818da347dSjmcneill
5918da347dSjmcneill void
tegra_cpufreq_register(const struct tegra_cpufreq_func * cf)6018da347dSjmcneill tegra_cpufreq_register(const struct tegra_cpufreq_func *cf)
6118da347dSjmcneill {
6218da347dSjmcneill const struct sysctlnode *node, *cpunode, *freqnode;
6318da347dSjmcneill u_int availfreq[TEGRA_CPUFREQ_MAX];
6418da347dSjmcneill size_t nfreq;
6518da347dSjmcneill int error;
6618da347dSjmcneill
67*2ab22fd0Sjmcneill KASSERT(cpufreq_func == NULL);
68*2ab22fd0Sjmcneill cpufreq_func = cf;
6918da347dSjmcneill
7018da347dSjmcneill nfreq = cpufreq_get_available(availfreq, TEGRA_CPUFREQ_MAX);
7118da347dSjmcneill if (nfreq == 0)
7218da347dSjmcneill return;
7318da347dSjmcneill
7418da347dSjmcneill KASSERT(nfreq <= TEGRA_CPUFREQ_MAX);
7518da347dSjmcneill
7618da347dSjmcneill for (int i = 0; i < nfreq; i++) {
7718da347dSjmcneill char buf[6];
7818da347dSjmcneill snprintf(buf, sizeof(buf), i ? " %u" : "%u", availfreq[i]);
7918da347dSjmcneill strcat(tegra_cpufreq_available, buf);
8018da347dSjmcneill }
8118da347dSjmcneill
8218da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, NULL, &node,
8318da347dSjmcneill CTLFLAG_PERMANENT, CTLTYPE_NODE, "machdep", NULL,
8418da347dSjmcneill NULL, 0, NULL, 0, CTL_MACHDEP, CTL_EOL);
8518da347dSjmcneill if (error)
8618da347dSjmcneill goto sysctl_failed;
8718da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, &node, &cpunode,
8818da347dSjmcneill 0, CTLTYPE_NODE, "cpu", NULL,
8918da347dSjmcneill NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
9018da347dSjmcneill if (error)
9118da347dSjmcneill goto sysctl_failed;
9218da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, &cpunode, &freqnode,
9318da347dSjmcneill 0, CTLTYPE_NODE, "frequency", NULL,
9418da347dSjmcneill NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL);
9518da347dSjmcneill if (error)
9618da347dSjmcneill goto sysctl_failed;
9718da347dSjmcneill
9818da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, &freqnode, &node,
9918da347dSjmcneill CTLFLAG_READWRITE, CTLTYPE_INT, "target", NULL,
10018da347dSjmcneill tegra_cpufreq_freq_helper, 0, NULL, 0,
10118da347dSjmcneill CTL_CREATE, CTL_EOL);
10218da347dSjmcneill if (error)
10318da347dSjmcneill goto sysctl_failed;
10418da347dSjmcneill cpufreq_node_target = node->sysctl_num;
10518da347dSjmcneill
10618da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, &freqnode, &node,
10718da347dSjmcneill CTLFLAG_READWRITE, CTLTYPE_INT, "current", NULL,
10818da347dSjmcneill tegra_cpufreq_freq_helper, 0, NULL, 0,
10918da347dSjmcneill CTL_CREATE, CTL_EOL);
11018da347dSjmcneill if (error)
11118da347dSjmcneill goto sysctl_failed;
11218da347dSjmcneill cpufreq_node_current = node->sysctl_num;
11318da347dSjmcneill
11418da347dSjmcneill error = sysctl_createv(&cpufreq_log, 0, &freqnode, &node,
11518da347dSjmcneill 0, CTLTYPE_STRING, "available", NULL,
11618da347dSjmcneill NULL, 0, tegra_cpufreq_available, 0,
11718da347dSjmcneill CTL_CREATE, CTL_EOL);
11818da347dSjmcneill if (error)
11918da347dSjmcneill goto sysctl_failed;
12018da347dSjmcneill cpufreq_node_available = node->sysctl_num;
12118da347dSjmcneill
122cfee7739Sjmcneill device_printf(curcpu()->ci_dev,
123cfee7739Sjmcneill "setting speed to %d MHz\n", availfreq[0]);
124802f340fSjmcneill cpufreq_set_rate(availfreq[0]);
12518da347dSjmcneill
12618da347dSjmcneill return;
12718da347dSjmcneill
12818da347dSjmcneill sysctl_failed:
12918da347dSjmcneill aprint_error("cpufreq: couldn't create sysctl nodes (%d)\n", error);
13018da347dSjmcneill sysctl_teardown(&cpufreq_log);
13118da347dSjmcneill }
13218da347dSjmcneill
13318da347dSjmcneill static int
tegra_cpufreq_freq_helper(SYSCTLFN_ARGS)13418da347dSjmcneill tegra_cpufreq_freq_helper(SYSCTLFN_ARGS)
13518da347dSjmcneill {
13618da347dSjmcneill struct sysctlnode node;
13718da347dSjmcneill int fq, oldfq = 0, error;
13818da347dSjmcneill
13918da347dSjmcneill node = *rnode;
14018da347dSjmcneill node.sysctl_data = &fq;
14118da347dSjmcneill
14218da347dSjmcneill fq = cpufreq_get_rate();
14318da347dSjmcneill if (rnode->sysctl_num == cpufreq_node_target)
14418da347dSjmcneill oldfq = fq;
14518da347dSjmcneill
14618da347dSjmcneill error = sysctl_lookup(SYSCTLFN_CALL(&node));
14718da347dSjmcneill if (error || newp == NULL)
14818da347dSjmcneill return error;
14918da347dSjmcneill
15018da347dSjmcneill if (fq == oldfq || rnode->sysctl_num != cpufreq_node_target)
15118da347dSjmcneill return 0;
15218da347dSjmcneill
15318da347dSjmcneill if (atomic_cas_uint(&cpufreq_busy, 0, 1) != 0)
15418da347dSjmcneill return EBUSY;
15518da347dSjmcneill
15618da347dSjmcneill error = cpufreq_set_rate(fq);
15718da347dSjmcneill if (error == 0) {
15818da347dSjmcneill pmf_event_inject(NULL, PMFE_SPEED_CHANGED);
15918da347dSjmcneill }
16018da347dSjmcneill
16118da347dSjmcneill atomic_dec_uint(&cpufreq_busy);
16218da347dSjmcneill
16318da347dSjmcneill return error;
16418da347dSjmcneill }
165