u-boot/arch/arm/mach-tegra/pwm.c

/*
 * Tegra pulse width frequency modulator definitions
 *
 * Copyright (c) 2011 The Chromium OS Authors.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <fdtdec.h>
#include <asm/io.h>
#include <asm/arch/clock.h>
#include <asm/arch/pwm.h>

struct pwm_info {
	struct pwm_ctlr *pwm;		/* Registers for our pwm controller */
	int pwm_node;			/* PWM device tree node */
} local;

void pwm_enable(unsigned channel, int rate, int pulse_width, int freq_divider)
{
	u32 reg;

	assert(channel < PWM_NUM_CHANNELS);

	/* TODO: Can we use clock_adjust_periph_pll_div() here? */
	if (rate) {
		clock_start_periph_pll(PERIPH_ID_PWM, CLOCK_ID_SFROM32KHZ,
				       rate);
	}

	reg = PWM_ENABLE_MASK;
	reg |= pulse_width << PWM_WIDTH_SHIFT;
	reg |= freq_divider << PWM_DIVIDER_SHIFT;
	writel(reg, &local.pwm[channel].control);
	debug("%s: channel=%d, rate=%d\n", __func__, channel, rate);
}

int pwm_request(const void *blob, int node, const char *prop_name)
{
	int pwm_node;
	u32 data[3];

	if (fdtdec_get_int_array(blob, node, prop_name, data,
			ARRAY_SIZE(data))) {
		debug("%s: Cannot decode PWM property '%s'\n", __func__,
		      prop_name);
		return -1;
	}

	pwm_node = fdt_node_offset_by_phandle(blob, data[0]);
	if (pwm_node != local.pwm_node) {
		debug("%s: PWM property '%s' phandle %d not recognised"
		      "- expecting %d\n", __func__, prop_name, data[0],
		      local.pwm_node);
		return -1;
	}
	if (data[1] >= PWM_NUM_CHANNELS) {
		debug("%s: PWM property '%s': invalid channel %u\n", __func__,
		      prop_name, data[1]);
		return -1;
	}

	/*
	 * TODO: We could maintain a list of requests, but it might not be
	 * worth it for U-Boot.
	 */
	return data[1];
}

int pwm_init(const void *blob)
{
	local.pwm_node = fdtdec_next_compatible(blob, 0,
						COMPAT_NVIDIA_TEGRA20_PWM);
	if (local.pwm_node < 0) {
		debug("%s: Cannot find device tree node\n", __func__);
		return -1;
	}

	local.pwm = (struct pwm_ctlr *)fdtdec_get_addr(blob, local.pwm_node,
						       "reg");
	if (local.pwm == (struct pwm_ctlr *)FDT_ADDR_T_NONE) {
		debug("%s: Cannot find pwm reg address\n", __func__);
		return -1;
	}
	debug("Tegra PWM at %p, node %d\n", local.pwm, local.pwm_node);

	return 0;
}