Module Name:    src
Committed By:   jmcneill
Date:           Wed Jul  4 23:06:55 UTC 2018

Modified Files:
        src/sys/arch/arm/samsung: files.exynos
Added Files:
        src/sys/arch/arm/samsung: exynos_pwm.c

Log Message:
Add driver for Exynos PWM timer.


To generate a diff of this commit:
cvs rdiff -u -r0 -r1.1 src/sys/arch/arm/samsung/exynos_pwm.c
cvs rdiff -u -r1.28 -r1.29 src/sys/arch/arm/samsung/files.exynos

Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.

Modified files:

Index: src/sys/arch/arm/samsung/files.exynos
diff -u src/sys/arch/arm/samsung/files.exynos:1.28 src/sys/arch/arm/samsung/files.exynos:1.29
--- src/sys/arch/arm/samsung/files.exynos:1.28	Tue Jul  3 16:09:04 2018
+++ src/sys/arch/arm/samsung/files.exynos	Wed Jul  4 23:06:54 2018
@@ -1,4 +1,4 @@
-#	$NetBSD: files.exynos,v 1.28 2018/07/03 16:09:04 jmcneill Exp $
+#	$NetBSD: files.exynos,v 1.29 2018/07/04 23:06:54 jmcneill Exp $
 #
 # Configuration info for Samsung Exynos SoC ARM Peripherals
 #
@@ -106,6 +106,11 @@ device	exyoi2c: i2cbus, i2c_bitbang
 attach	exyoi2c at fdt with exynos_i2c
 file	arch/arm/samsung/exynos_i2c.c		exynos_i2c needs-flag
 
+# PWM timer
+device	expwm: pwm
+attach	expwm at fdt with exynos_pwm
+file	arch/arm/samsung/exynos_pwm.c		exynos_pwm
+
 device	exy5422clk: clk
 attach	exy5422clk at fdt with exynos5422_clock
 file	arch/arm/samsung/exynos5422_clock.c	exynos5422_clock

Added files:

Index: src/sys/arch/arm/samsung/exynos_pwm.c
diff -u /dev/null src/sys/arch/arm/samsung/exynos_pwm.c:1.1
--- /dev/null	Wed Jul  4 23:06:55 2018
+++ src/sys/arch/arm/samsung/exynos_pwm.c	Wed Jul  4 23:06:54 2018
@@ -0,0 +1,263 @@
+/* $NetBSD: exynos_pwm.c,v 1.1 2018/07/04 23:06:54 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2018 Jared McNeill <jmcne...@invisible.ca>
+ * All rights reserved.
+ *
+ * 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 NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
+ */
+
+#include <sys/cdefs.h>
+
+__KERNEL_RCSID(1, "$NetBSD: exynos_pwm.c,v 1.1 2018/07/04 23:06:54 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/device.h>
+#include <sys/intr.h>
+#include <sys/systm.h>
+#include <sys/time.h>
+
+#include <dev/pwm/pwmvar.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#define	TCFG0			0x00
+#define	TCFG1			0x04
+#define	TCON			0x08
+#define	 _TCON_OFF(n)		((n) == 0 ? 0 : (((n) + 1) * 4))
+#define	 TCON_START(n)		__BIT(_TCON_OFF(n) + 0)
+#define	 TCON_UPDATE(n)		__BIT(_TCON_OFF(n) + 1)
+#define	 TCON_OUTINV(n)		__BIT(_TCON_OFF(n) + 2)
+#define	 TCON_AUTO_RELOAD(n)	__BIT(_TCON_OFF(n) + 3)
+#define	 TCON_DEADZONE_EN(n)	__BIT(_TCON_OFF(n) + 4)
+#define	TCNTB(n)		(0x0c + (n) * 12)
+#define	TCMPB(n)		(0x10 + (n) * 12)
+#define	TCNTO(n)		(0x14 + (n) * 12)
+#define	TINT_CSTAT		0x44
+
+#define	PWM_NTIMERS		5
+
+static const char * const compatible[] = {
+	"samsung,exynos4210-pwm",
+	NULL
+};
+
+struct exynos_pwm_softc;
+
+struct exynos_pwm_timer {
+	u_int			timer_index;
+	struct pwm_controller	timer_pwm;
+};
+
+struct exynos_pwm_softc {
+	device_t		sc_dev;
+	bus_space_tag_t		sc_bst;
+	bus_space_handle_t	sc_bsh;
+
+	struct exynos_pwm_timer	sc_timer[PWM_NTIMERS];
+	u_int			sc_timermask;
+
+	u_int			sc_clkfreq;
+};
+
+#define	PWM_READ(sc, reg)		\
+	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
+#define	PWM_WRITE(sc, reg, val)		\
+	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
+
+static int
+exynos_pwm_enable(pwm_tag_t pwm, bool enable)
+{
+	struct exynos_pwm_timer * const timer = pwm->pwm_priv;
+	struct exynos_pwm_softc * const sc = device_private(pwm->pwm_dev);
+	uint32_t tcon;
+
+	if (enable) {
+		tcon = PWM_READ(sc, TCON);
+		tcon &= ~TCON_START(timer->timer_index);
+		tcon |= TCON_UPDATE(timer->timer_index);
+		PWM_WRITE(sc, TCON, tcon);
+		tcon &= ~TCON_UPDATE(timer->timer_index);
+		tcon |= TCON_START(timer->timer_index);
+		tcon |= TCON_AUTO_RELOAD(timer->timer_index);
+		PWM_WRITE(sc, TCON, tcon);
+	} else {
+		tcon = PWM_READ(sc, TCON);
+		tcon &= ~TCON_AUTO_RELOAD(timer->timer_index);
+		PWM_WRITE(sc, TCON, tcon);
+	}
+
+	return 0;
+}
+
+static int
+exynos_pwm_get_config(pwm_tag_t pwm, struct pwm_config *conf)
+{
+	struct exynos_pwm_timer * const timer = pwm->pwm_priv;
+	struct exynos_pwm_softc * const sc = device_private(pwm->pwm_dev);
+	uint32_t tcon, tcntb, tcmpb;
+
+	tcon = PWM_READ(sc, TCON);
+	tcntb = PWM_READ(sc, TCNTB(timer->timer_index));
+	tcmpb = PWM_READ(sc, TCMPB(timer->timer_index));
+
+	conf->polarity = (tcon & TCON_OUTINV(timer->timer_index)) ? PWM_ACTIVE_HIGH : PWM_ACTIVE_LOW;
+	conf->period = (u_int)(((uint64_t)tcntb * 1000000000) / sc->sc_clkfreq);
+	conf->duty_cycle = (u_int)(((uint64_t)tcmpb * 1000000000) / sc->sc_clkfreq);
+
+	return 0;
+}
+
+static int
+exynos_pwm_set_config(pwm_tag_t pwm, const struct pwm_config *conf)
+{
+	struct exynos_pwm_timer * const timer = pwm->pwm_priv;
+	struct exynos_pwm_softc * const sc = device_private(pwm->pwm_dev);
+	uint32_t tcon, tcntb, tcmpb;
+
+	tcon = PWM_READ(sc, TCON);
+	if (conf->polarity == PWM_ACTIVE_HIGH)
+		tcon |= TCON_OUTINV(timer->timer_index);
+	else
+		tcon &= ~TCON_OUTINV(timer->timer_index);
+	PWM_WRITE(sc, TCON, tcon);
+
+	tcntb = conf->period / (1000000000 / sc->sc_clkfreq);
+	tcmpb = conf->duty_cycle / (1000000000 / sc->sc_clkfreq);
+	if (tcmpb == 0)
+		tcmpb = 1;
+	tcmpb = tcntb - tcmpb;
+
+	PWM_WRITE(sc, TCNTB(timer->timer_index), tcntb - 1);
+	PWM_WRITE(sc, TCMPB(timer->timer_index), tcmpb - 1);
+
+	tcon = PWM_READ(sc, TCON);
+	tcon |= TCON_UPDATE(timer->timer_index);
+	tcon |= TCON_AUTO_RELOAD(timer->timer_index);
+	PWM_WRITE(sc, TCON, tcon);
+
+	tcon &= ~TCON_UPDATE(timer->timer_index);
+	PWM_WRITE(sc, TCON, tcon);
+
+	return 0;
+}
+
+static pwm_tag_t
+exynos_pwm_get_tag(device_t dev, const void *data, size_t len)
+{
+	struct exynos_pwm_softc * const sc = device_private(dev);
+	struct exynos_pwm_timer *timer;
+	const u_int *pwm = data;
+	struct pwm_config conf;
+
+	if (len != 16)
+		return NULL;
+
+	const u_int index = be32toh(pwm[1]);
+	if (index >= 32 || (sc->sc_timermask & __BIT(index)) == 0)
+		return NULL;
+
+	const u_int period = be32toh(pwm[2]);
+	const u_int polarity = be32toh(pwm[3]);
+
+	timer = &sc->sc_timer[index];
+
+	/* Set initial timer polarity and period from specifier */
+	exynos_pwm_get_config(&timer->timer_pwm, &conf);
+	conf.period = period;
+	conf.polarity = polarity ? PWM_ACTIVE_LOW : PWM_ACTIVE_HIGH;
+	exynos_pwm_set_config(&timer->timer_pwm, &conf);
+
+	return &timer->timer_pwm;
+}
+
+static struct fdtbus_pwm_controller_func exynos_pwm_funcs = {
+	.get_tag = exynos_pwm_get_tag
+};
+
+static int
+exynos_pwm_match(device_t parent, cfdata_t cf, void *aux)
+{
+	struct fdt_attach_args * const faa = aux;
+
+	return of_match_compatible(faa->faa_phandle, compatible);
+}
+
+static void
+exynos_pwm_attach(device_t parent, device_t self, void *aux)
+{
+	struct exynos_pwm_softc * const sc = device_private(self);
+	struct fdt_attach_args * const faa = aux;
+	const int phandle = faa->faa_phandle;
+	const u_int *data;
+	struct clk *clk;
+	bus_addr_t addr;
+	bus_size_t size;
+	int error, len, n;
+
+	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
+		aprint_error(": couldn't get registers\n");
+		return;
+	}
+
+	clk = fdtbus_clock_get(phandle, "timers");
+	if (clk == NULL || clk_enable(clk) != 0) {
+		aprint_error(": couldn't enable timers clock\n");
+		return;
+	}
+
+	sc->sc_dev = self;
+	sc->sc_clkfreq = clk_get_rate(clk);
+	sc->sc_bst = faa->faa_bst;
+	error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh);
+	if (error) {
+		aprint_error(": couldn't map %#llx: %d", (uint64_t)addr, error);
+		return;
+	}
+	for (n = 0; n < PWM_NTIMERS; n++) {
+		sc->sc_timer[n].timer_index = n;
+		sc->sc_timer[n].timer_pwm.pwm_enable = exynos_pwm_enable;
+		sc->sc_timer[n].timer_pwm.pwm_get_config = exynos_pwm_get_config;
+		sc->sc_timer[n].timer_pwm.pwm_set_config = exynos_pwm_set_config;
+		sc->sc_timer[n].timer_pwm.pwm_dev = self;
+		sc->sc_timer[n].timer_pwm.pwm_priv = &sc->sc_timer[n];
+		sc->sc_timermask |= __BIT(n);
+	}
+
+	data = fdtbus_get_prop(phandle, "samsung,pwm-outputs", &len);
+	if (data) {
+		sc->sc_timermask = 0;
+		for (n = 0; n < len / 4; n++) {
+			sc->sc_timermask |= __BIT(be32toh(data[n]));
+		}
+	}
+
+	aprint_naive("\n");
+	aprint_normal(": PWM\n");
+
+	fdtbus_register_pwm_controller(self, phandle,
+	    &exynos_pwm_funcs);
+}
+
+CFATTACH_DECL_NEW(exynos_pwm, sizeof(struct exynos_pwm_softc),
+	exynos_pwm_match, exynos_pwm_attach, NULL, NULL);

Reply via email to