Differential D36027 Diff 108888 sys/arm64/rockchip/rk3568_iodomain.c

Changeset View

Standalone View

sys/arm64/rockchip/rk3568_iodomain.c

				/*-
				* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
				*
				* Copyright (c) 2021, 2022 Soren Schmidt <sos@deepcore.dk>
				*
				* Redistribution and use in source and binary forms, with or without
				* modification, are permitted provided that the following conditions
				* are met:
				* 1. Redistributions of source code must retain the above copyright
				* notice, this list of conditions and the following disclaimer.
				* 2. Redistributions in binary form must reproduce the above copyright
				* notice, this list of conditions and the following disclaimer in the
				* documentation and/or other materials provided with the distribution.
				*
				* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
				* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
				* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
				* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
				* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
				* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
				* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
				* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
				* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
				* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
				* SUCH DAMAGE.
				*
				* $Id: rk3568_iodomain.c 893 2022-07-26 09:47:22Z sos $
				*/

				#include <sys/cdefs.h>
				#include <sys/param.h>
				#include <sys/systm.h>
				#include <sys/bus.h>
				#include <sys/kernel.h>
				#include <sys/module.h>

				#include <dev/ofw/ofw_bus.h>
				#include <dev/ofw/ofw_bus_subr.h>

				#include <dev/extres/syscon/syscon.h>
				#include <dev/extres/regulator/regulator.h>

				#include "syscon_if.h"

				#define RK3568_PMU_GRF_IO_VSEL0 0x0140
				#define RK3568_PMU_GRF_IO_VSEL1 0x0144
				#define RK3568_PMU_GRF_IO_VSEL2 0x0148

				#define MAX_1V8 1850000

				struct rk3568_iodomain_supply {
				char *name;
				uint32_t bit;
				};

				static struct rk3568_iodomain_supply rk3568_pmu_supply[] = {
				{"pmuio1-supply", 0},
				{"pmuio2-supply", 1},
				{"vccio1-supply", 1},
				{"vccio2-supply", 2},
				{"vccio3-supply", 3},
				{"vccio4-supply", 4},
				{"vccio5-supply", 5},
				{"vccio6-supply", 6},
				{"vccio7-supply", 7},
				};

				static struct ofw_compat_data compat_data[] = {
				{"rockchip,rk3568-pmu-io-voltage-domain", 1},
				{NULL, 0}
				};

				manuUnsubmitted Not Done Inline Actions Why the need for this file ? Why not adding support in rk_iodomain.c ? manu: Why the need for this file ? Why not adding support in rk_iodomain.c ?

				static int
				rk3568_iodomain_probe(device_t dev)
				{

				if (!ofw_bus_status_okay(dev))
				return (ENXIO);
				if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0)
				return (ENXIO);
				device_set_desc(dev, "RockChip IO Voltage Domain");
				return (BUS_PROBE_DEFAULT);
				}

				static int
				rk3568_iodomain_attach(device_t dev)
				{
				phandle_t node = ofw_bus_get_node(dev);
				struct syscon *grf;
				regulator_t supply;
				int uvolt, i;

				if (syscon_get_handle_default(dev, &grf)) {
				device_printf(dev, "Cannot get grf handle\n");
				return (ENXIO);
				}

				for (i = 0; i < nitems(rk3568_pmu_supply); i++) {
				if (regulator_get_by_ofw_property(dev, node,
				rk3568_pmu_supply[i].name, &supply))
				return (ENXIO);

				if (regulator_get_voltage(supply, &uvolt)) {
				device_printf(dev,
				"Cannot get voltage for regulator %s\n",
				rk3568_pmu_supply[i].name);
				} else {
				if (bootverbose)
				device_printf(dev,
				"Setting regulator %s voltage=%duV\n",
				rk3568_pmu_supply[i].name, uvolt);
				switch (i) {
				case 1:
				SYSCON_WRITE_4(grf, RK3568_PMU_GRF_IO_VSEL2,
				(1 << (rk3568_pmu_supply[i].bit + 16)) \|
				(uvolt > MAX_1V8 ?
				0 : 1 << rk3568_pmu_supply[i].bit));
				SYSCON_WRITE_4(grf, RK3568_PMU_GRF_IO_VSEL2,
				(1 << (rk3568_pmu_supply[i].bit + 4 + 16)) \|
				(uvolt > MAX_1V8 ?
				1 << (rk3568_pmu_supply[i].bit + 4) : 0));
				break;

				case 2: case 4: case 5: case 6: case 7: case 8:
				SYSCON_WRITE_4(grf, RK3568_PMU_GRF_IO_VSEL0,
				(1 << (rk3568_pmu_supply[i].bit + 16)) \|
				(uvolt > MAX_1V8 ?
				0 : 1 << rk3568_pmu_supply[i].bit));
				SYSCON_WRITE_4(grf, RK3568_PMU_GRF_IO_VSEL1,
				(1 << (rk3568_pmu_supply[i].bit + 16)) \|
				(uvolt > MAX_1V8 ?
				1 << rk3568_pmu_supply[i].bit : 0));
				break;

				case 0: case 3:
				break;

				default:
				device_printf(dev, "Index out of range\n");
				};
				}
				}
				return (0);
				}

				static device_method_t rk3568_iodomain_methods[] = {
				/* Device interface */
				DEVMETHOD(device_probe, rk3568_iodomain_probe),
				DEVMETHOD(device_attach, rk3568_iodomain_attach),

				DEVMETHOD_END
				};

				static driver_t rk3568_iodomain_driver = {
				"rk3568_iodomain", rk3568_iodomain_methods, 0,
				};

				static devclass_t rk3568_iodomain_devclass;

				EARLY_DRIVER_MODULE(rk3568_iodomain, simplebus, rk3568_iodomain_driver,
				rk3568_iodomain_devclass, 0, 0, BUS_PASS_INTERRUPT + BUS_PASS_ORDER_MIDDLE);