Module Name:    src
Committed By:   jakllsch
Date:           Wed Jan 31 16:24:11 UTC 2018

Modified Files:
        src/sys/arch/arm/sunxi: files.sunxi
        src/sys/arch/evbarm/conf: SUNXI
Added Files:
        src/sys/arch/arm/sunxi: sun6i_spi.c

Log Message:
Add sun6i SPI driver.

Currently PIO-only.


To generate a diff of this commit:
cvs rdiff -u -r1.38 -r1.39 src/sys/arch/arm/sunxi/files.sunxi
cvs rdiff -u -r0 -r1.1 src/sys/arch/arm/sunxi/sun6i_spi.c
cvs rdiff -u -r1.57 -r1.58 src/sys/arch/evbarm/conf/SUNXI

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/sunxi/files.sunxi
diff -u src/sys/arch/arm/sunxi/files.sunxi:1.38 src/sys/arch/arm/sunxi/files.sunxi:1.39
--- src/sys/arch/arm/sunxi/files.sunxi:1.38	Fri Nov 10 00:09:23 2017
+++ src/sys/arch/arm/sunxi/files.sunxi	Wed Jan 31 16:24:11 2018
@@ -1,4 +1,4 @@
-#	$NetBSD: files.sunxi,v 1.38 2017/11/10 00:09:23 jmcneill Exp $
+#	$NetBSD: files.sunxi,v 1.39 2018/01/31 16:24:11 jakllsch Exp $
 #
 # Configuration info for Allwinner sunxi family SoCs
 #
@@ -227,6 +227,11 @@ device	sunxinand: nandbus
 attach	sunxinand at fdt with sunxi_nand
 file	arch/arm/sunxi/sunxi_nand.c		sunxi_nand
 
+# SPI Controller (sun6i-compatible)
+device	sun6ispi: spibus
+attach	sun6ispi at fdt with sun6i_spi
+file	arch/arm/sunxi/sun6i_spi.c		sun6i_spi
+
 # SOC parameters
 defflag	opt_soc.h			SOC_SUNXI
 defflag	opt_soc.h			SOC_SUN4I: SOC_SUNXI

Index: src/sys/arch/evbarm/conf/SUNXI
diff -u src/sys/arch/evbarm/conf/SUNXI:1.57 src/sys/arch/evbarm/conf/SUNXI:1.58
--- src/sys/arch/evbarm/conf/SUNXI:1.57	Mon Dec 18 19:00:42 2017
+++ src/sys/arch/evbarm/conf/SUNXI	Wed Jan 31 16:24:11 2018
@@ -1,5 +1,5 @@
 #
-#	$NetBSD: SUNXI,v 1.57 2017/12/18 19:00:42 jmcneill Exp $
+#	$NetBSD: SUNXI,v 1.58 2018/01/31 16:24:11 jakllsch Exp $
 #
 #	Allwinner sunxi family
 #
@@ -237,6 +237,10 @@ sy8106a*	at iic?			# Silergy SY81061 reg
 pcf8563rtc*	at iic?			# PCF8563 RTC
 seeprom*	at iic?			# AT24Cxx Serial EEPROM
 
+# SPI
+sun6ispi*	at fdt?
+spi*		at spibus?
+
 # RTC
 sunxirtc*	at fdt?			# RTC
 

Added files:

Index: src/sys/arch/arm/sunxi/sun6i_spi.c
diff -u /dev/null src/sys/arch/arm/sunxi/sun6i_spi.c:1.1
--- /dev/null	Wed Jan 31 16:24:11 2018
+++ src/sys/arch/arm/sunxi/sun6i_spi.c	Wed Jan 31 16:24:11 2018
@@ -0,0 +1,424 @@
+/*	$NetBSD: sun6i_spi.c,v 1.1 2018/01/31 16:24:11 jakllsch Exp $	*/
+
+/*
+ * Copyright (c) 2018 Jonathan A. Kollasch
+ * 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 COPYRIGHT HOLDERS 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 COPYRIGHT HOLDER 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(0, "$NetBSD: sun6i_spi.c,v 1.1 2018/01/31 16:24:11 jakllsch Exp $");
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/systm.h>
+#include <sys/mutex.h>
+#include <sys/bus.h>
+#include <sys/intr.h>
+#include <sys/kernel.h>
+
+#include <sys/bitops.h>
+#include <dev/spi/spivar.h>
+
+#include <arm/sunxi/sun6i_spireg.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#include <arm/fdt/arm_fdtvar.h>
+
+#define SPI_IER_DEFAULT (SPI_IER_TC_INT_EN | SPI_IER_TF_UDR_INT_EN | \
+	SPI_IER_TF_OVF_INT_EN | SPI_IER_RF_UDR_INT_EN | SPI_IER_RF_OVF_INT_EN)
+
+struct sun6ispi_softc {
+	device_t		sc_dev;
+	bus_space_tag_t		sc_iot;
+	bus_space_handle_t	sc_ioh;
+	void			*sc_intrh;
+	struct spi_controller	sc_spi;
+	SIMPLEQ_HEAD(,spi_transfer) sc_q;
+	struct spi_transfer	*sc_transfer;
+	struct spi_chunk	*sc_wchunk;
+	struct spi_chunk	*sc_rchunk;
+	uint32_t		sc_TCR;
+	u_int			sc_modclkrate;
+	volatile bool		sc_running;
+};
+
+static int sun6ispi_match(device_t, cfdata_t, void *);
+static void sun6ispi_attach(device_t, device_t, void *);
+
+static int sun6ispi_configure(void *, int, int, int);
+static int sun6ispi_transfer(void *, struct spi_transfer *);
+
+static void sun6ispi_start(struct sun6ispi_softc * const);
+static int sun6ispi_intr(void *);
+
+static void sun6ispi_send(struct sun6ispi_softc * const);
+static void sun6ispi_recv(struct sun6ispi_softc * const);
+
+CFATTACH_DECL_NEW(sun6i_spi, sizeof(struct sun6ispi_softc),
+    sun6ispi_match, sun6ispi_attach, NULL, NULL);
+
+static int
+sun6ispi_match(device_t parent, cfdata_t cf, void *aux)
+{
+	const char * const compatible[] = {
+		"allwinner,sun8i-h3-spi",
+		NULL
+	};
+	struct fdt_attach_args * const faa = aux;
+
+	return of_match_compatible(faa->faa_phandle, compatible);
+}
+
+static void
+sun6ispi_attach(device_t parent, device_t self, void *aux)
+{
+	struct sun6ispi_softc * const sc = device_private(self);
+	struct fdt_attach_args * const faa = aux;
+	struct spibus_attach_args sba;
+	struct fdtbus_reset *rst;
+	struct clk *clk, *modclk;
+	uint32_t gcr, isr;
+	char intrstr[128];
+
+	aprint_naive("\n");
+	aprint_normal(": SPI\n");
+
+	sc->sc_dev = self;
+	sc->sc_iot = faa->faa_bst;
+	SIMPLEQ_INIT(&sc->sc_q);
+
+	const int phandle = faa->faa_phandle;
+	bus_addr_t addr;
+	bus_size_t size;
+
+	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
+		aprint_error_dev(sc->sc_dev, "missing 'reg' property\n");
+		return;
+	}
+
+	if (bus_space_map(sc->sc_iot, addr, size, 0, &sc->sc_ioh) != 0) {
+		aprint_error_dev(sc->sc_dev, "unable to map device\n");
+		return;
+	}
+
+	if ((clk = fdtbus_clock_get_index(phandle, 0)) != NULL) {
+		if (clk_enable(clk) != 0) {
+			aprint_error_dev(sc->sc_dev, "couldn't enable clock\n");
+			return;
+		}
+		device_printf(self, "%s ahb @ %uHz\n", __func__, clk_get_rate(clk));
+	}
+
+	if ((modclk = fdtbus_clock_get(phandle, "mod")) != NULL) {
+		/* 200MHz max on H3,H5 */
+		if (clk_set_rate(modclk, 200000000) != 0) {
+			aprint_error_dev(sc->sc_dev, "couldn't configure module clock\n");
+			return;
+		}
+		if (clk_enable(modclk) != 0) {
+			aprint_error_dev(sc->sc_dev, "couldn't enable module clock\n");
+			return;
+		}
+		sc->sc_modclkrate = clk_get_rate(modclk);
+		device_printf(self, "%s %uHz\n", __func__, sc->sc_modclkrate);
+	}
+
+	if ((rst = fdtbus_reset_get_index(phandle, 0)) != NULL)
+		if (fdtbus_reset_deassert(rst) != 0) {
+			aprint_error(": couldn't de-assert reset\n");
+			return;
+		}
+
+	isr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA);
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA, isr);
+
+	if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
+		aprint_error(": failed to decode interrupt\n");
+		return;
+	}
+
+	sc->sc_intrh = fdtbus_intr_establish(phandle, 0, IPL_VM, 0,
+	    sun6ispi_intr, sc);
+	if (sc->sc_intrh == NULL) {
+		aprint_error_dev(sc->sc_dev, "unable to establish interrupt\n");
+		return;
+	}
+	aprint_normal_dev(self, "interrupting on %s\n", intrstr);
+
+	gcr = SPI_GCR_SRST;
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_GCR, gcr);
+	do {
+	} while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_GCR) & SPI_GCR_SRST) != 0);
+	gcr = SPI_GCR_TP_EN | SPI_GCR_MODE | SPI_GCR_EN;
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_GCR, gcr);
+
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_IER, SPI_IER_DEFAULT);
+
+	sc->sc_spi.sct_cookie = sc;
+	sc->sc_spi.sct_configure = sun6ispi_configure;
+	sc->sc_spi.sct_transfer = sun6ispi_transfer;
+	sc->sc_spi.sct_nslaves = 4;
+
+	sba.sba_controller = &sc->sc_spi;
+
+	(void) config_found_ia(self, "spibus", &sba, spibus_print);
+}
+
+static int
+sun6ispi_configure(void *cookie, int slave, int mode, int speed)
+{
+	struct sun6ispi_softc * const sc = cookie;
+	uint32_t tcr, cctl;
+
+#if 0
+	device_printf(sc->sc_dev, "%s slave %d mode %d speed %d\n", __func__, slave, mode, speed);
+
+	if (speed > 200000)
+		speed = 200000;
+#endif
+
+	tcr = SPI_TCR_SS_LEVEL | SPI_TCR_SPOL;
+
+	if (slave > 3)
+		return EINVAL;
+
+	if (speed <= 0)
+		return EINVAL;
+
+	switch (mode) {
+	case SPI_MODE_0:
+		tcr |= 0;
+		break;
+	case SPI_MODE_1:
+		tcr |= SPI_TCR_CPHA;
+		break;
+	case SPI_MODE_2:
+		tcr |= SPI_TCR_CPOL;
+		break;
+	case SPI_MODE_3:
+		tcr |= SPI_TCR_CPHA|SPI_TCR_CPOL;
+		break;
+	default:
+		return EINVAL;
+	}
+
+	sc->sc_TCR = tcr;
+
+	if (speed < 3000 || speed > 200000000)
+		return EINVAL;
+
+	if (speed > sc->sc_modclkrate / 2 || speed < sc->sc_modclkrate / 512) {
+		for (cctl = 0; cctl <= __SHIFTOUT_MASK(SPI_CCTL_CDR1); cctl++) {
+			if ((sc->sc_modclkrate / (1<<cctl)) <= speed)
+				goto cdr1_found;
+		}
+		return EINVAL;
+cdr1_found:
+		cctl = __SHIFTIN(cctl, SPI_CCTL_CDR1);
+	} else {
+		cctl = howmany(sc->sc_modclkrate, 2 * speed) - 1;
+		cctl = SPI_CCTL_DRS|__SHIFTIN(cctl, SPI_CCTL_CDR2);
+	}
+
+	device_printf(sc->sc_dev, "%s CCTL 0x%08x\n", __func__, cctl);
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_CCTL, cctl);
+
+	return 0;
+}
+
+static int
+sun6ispi_transfer(void *cookie, struct spi_transfer *st)
+{
+	struct sun6ispi_softc * const sc = cookie;
+	int s;
+
+	s = splbio();
+	spi_transq_enqueue(&sc->sc_q, st);
+	if (sc->sc_running == false) {
+		sun6ispi_start(sc);
+	}
+	splx(s);
+	return 0;
+}
+
+static size_t
+chunks_total_count(struct spi_transfer * st)
+{
+	struct spi_chunk *chunk = st->st_chunks;
+	size_t len = 0;
+
+	do {
+		len += chunk->chunk_count;
+	} while ((chunk = chunk->chunk_next) != NULL);
+
+	return len;
+}
+
+static void
+sun6ispi_start(struct sun6ispi_softc * const sc)
+{
+	struct spi_transfer *st;
+	uint32_t isr, tcr;
+	size_t ctc;
+
+	//device_printf(sc->sc_dev, "%s\n", __func__);
+	while ((st = spi_transq_first(&sc->sc_q)) != NULL) {
+
+		spi_transq_dequeue(&sc->sc_q);
+
+		KASSERT(sc->sc_transfer == NULL);
+		sc->sc_transfer = st;
+		sc->sc_rchunk = sc->sc_wchunk = st->st_chunks;
+		sc->sc_running = true;
+
+		isr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA);
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA, isr);
+
+		//printf("%s fcr 0x%08x\n", __func__, bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_FCR));
+
+		ctc = chunks_total_count(st);
+		//printf("%s total count %zu\n", __func__, ctc);
+
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_BC, __SHIFTIN(ctc, SPI_BC_MBC));
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_TC, __SHIFTIN(ctc, SPI_TC_MWTC));
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_BCC, __SHIFTIN(ctc, SPI_BCC_STC));
+
+		KASSERT(st->st_slave <= 3);
+		tcr = sc->sc_TCR | __SHIFTIN(st->st_slave, SPI_TCR_SS_SEL);
+
+		//device_printf(sc->sc_dev, "%s before TCR write\n", __func__);
+		//bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_TCR, tcr);
+
+		sun6ispi_send(sc);
+
+		const uint32_t ier = SPI_IER_DEFAULT | SPI_IER_RF_RDY_INT_EN | SPI_IER_TX_ERQ_INT_EN;
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_IER, ier);
+
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_TCR, tcr|SPI_TCR_XCH);
+		//device_printf(sc->sc_dev, "%s after TCR write\n", __func__);
+
+		if (!cold)
+			return;
+
+		//device_printf(sc->sc_dev, "%s cold\n", __func__);
+
+		int s = splbio();
+		for (;;) {
+			sun6ispi_intr(sc);
+			if (ISSET(st->st_flags, SPI_F_DONE))
+				break;
+		}
+		splx(s);
+	}
+
+	sc->sc_running = false;
+//	device_printf(sc->sc_dev, "%s finishes\n", __func__);
+}
+
+static void
+sun6ispi_send(struct sun6ispi_softc * const sc)
+{
+	uint8_t fd;
+	uint32_t fsr;
+	struct spi_chunk *chunk;
+
+	//device_printf(sc->sc_dev, "%s\n", __func__);
+
+	while ((chunk = sc->sc_wchunk) != NULL) {
+		while (chunk->chunk_wresid) {
+			fsr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_FSR);
+			if (__SHIFTOUT(fsr, SPI_FSR_TF_CNT) >= 64) {
+				//printf("%s fsr 0x%08x\n", __func__, fsr);
+				return;
+			}
+			if (chunk->chunk_wptr) {
+				fd = *chunk->chunk_wptr++;
+			} else {
+				fd = '\0';
+			}
+			//printf("%s fd %02x\n", __func__, fd);
+			bus_space_write_1(sc->sc_iot, sc->sc_ioh, SPI_TXD, fd);
+			chunk->chunk_wresid--;
+		}
+		sc->sc_wchunk = sc->sc_wchunk->chunk_next;
+	}
+}
+
+static void
+sun6ispi_recv(struct sun6ispi_softc * const sc)
+{
+	uint8_t fd;
+	uint32_t fsr;
+	struct spi_chunk *chunk;
+
+	//device_printf(sc->sc_dev, "%s\n", __func__);
+
+	while ((chunk = sc->sc_rchunk) != NULL) {
+		while (chunk->chunk_rresid) {
+			fsr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_FSR);
+			if (__SHIFTOUT(fsr, SPI_FSR_RF_CNT) == 0) {
+				//printf("%s fsr 0x%08x\n", __func__, fsr);
+				return;
+			}
+			fd = bus_space_read_1(sc->sc_iot, sc->sc_ioh, SPI_RXD);
+			//printf("%s fd %02x\n", __func__, fd);
+			if (chunk->chunk_rptr) {
+				*chunk->chunk_rptr++ = fd;
+			}
+			chunk->chunk_rresid--;
+		}
+		sc->sc_rchunk = sc->sc_rchunk->chunk_next;
+	}
+}
+
+static int
+sun6ispi_intr(void *cookie)
+{
+	struct sun6ispi_softc * const sc = cookie;
+	struct spi_transfer *st;
+	uint32_t isr;
+
+	isr = bus_space_read_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA);
+	bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_INT_STA, isr);
+	//device_printf(sc->sc_dev, "%s ISR 0x%08x\n", __func__, isr);
+
+	if (ISSET(isr, SPI_ISR_RX_RDY)) {
+		sun6ispi_recv(sc);
+		sun6ispi_send(sc);
+	}
+
+	if (ISSET(isr, SPI_ISR_TC)) {
+		bus_space_write_4(sc->sc_iot, sc->sc_ioh, SPI_IER, SPI_IER_DEFAULT);
+
+		sc->sc_rchunk = sc->sc_wchunk = NULL;
+		st = sc->sc_transfer;
+		sc->sc_transfer = NULL;
+		KASSERT(st != NULL);
+		spi_done(st, 0);
+		sc->sc_running = false;
+	}
+
+	return isr;
+}

Reply via email to