Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/dev/spi add spi(4) bus frontend for ssdfb(4)
details: https://anonhg.NetBSD.org/src/rev/91a7a6b50fc9
branches: trunk
changeset: 460747:91a7a6b50fc9
user: tnn <tnn%NetBSD.org@localhost>
date: Sat Nov 02 14:33:27 2019 +0000
description:
add spi(4) bus frontend for ssdfb(4)
diffstat:
sys/dev/spi/files.spi | 6 +-
sys/dev/spi/ssdfb_spi.c | 339 ++++++++++++++++++++++++++++++++++++++++++++++++
2 files changed, 344 insertions(+), 1 deletions(-)
diffs (truncated from 363 to 300 lines):
diff -r e4de232062fc -r 91a7a6b50fc9 sys/dev/spi/files.spi
--- a/sys/dev/spi/files.spi Sat Nov 02 14:23:59 2019 +0000
+++ b/sys/dev/spi/files.spi Sat Nov 02 14:33:27 2019 +0000
@@ -1,4 +1,4 @@
-# $NetBSD: files.spi,v 1.6 2019/08/05 23:42:48 tnn Exp $
+# $NetBSD: files.spi,v 1.7 2019/11/02 14:33:27 tnn Exp $
define spibus { }
@@ -36,6 +36,10 @@
attach mcp23s17gpio at spi
file dev/spi/mcp23s17.c mcp23s17gpio
+# Solomon Systech SSD13xx PLED/OLED display
+attach ssdfb at spi with ssdfb_spi
+file dev/spi/ssdfb_spi.c ssdfb_spi
+
# MCP3x0x ADC
device mcp3kadc: sysmon_envsys
attach mcp3kadc at spi
diff -r e4de232062fc -r 91a7a6b50fc9 sys/dev/spi/ssdfb_spi.c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/dev/spi/ssdfb_spi.c Sat Nov 02 14:33:27 2019 +0000
@@ -0,0 +1,339 @@
+/* $NetBSD: ssdfb_spi.c,v 1.1 2019/11/02 14:33:27 tnn Exp $ */
+
+/*
+ * Copyright (c) 2019 The NetBSD Foundation, Inc.
+ * All rights reserved.
+ *
+ * This code is derived from software contributed to The NetBSD Foundation
+ * by Tobias Nygren.
+ *
+ * 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(0, "$NetBSD: ssdfb_spi.c,v 1.1 2019/11/02 14:33:27 tnn Exp $");
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/kernel.h>
+#include <dev/wscons/wsdisplayvar.h>
+#include <dev/rasops/rasops.h>
+#include <dev/spi/spivar.h>
+#include <dev/ic/ssdfbvar.h>
+
+struct bs_state {
+ uint8_t *base;
+ uint8_t *cur;
+ uint8_t mask;
+};
+
+struct ssdfb_spi_softc {
+ struct ssdfb_softc sc;
+ struct spi_handle *sc_sh;
+ bool sc_3wiremode;
+};
+
+static int ssdfb_spi_match(device_t, cfdata_t, void *);
+static void ssdfb_spi_attach(device_t, device_t, void *);
+
+static int ssdfb_spi_cmd_3wire(void *, uint8_t *, size_t, bool);
+static int ssdfb_spi_xfer_rect_3wire_ssd1322(void *, uint8_t, uint8_t,
+ uint8_t, uint8_t, uint8_t *, size_t, bool);
+
+static int ssdfb_spi_cmd_4wire(void *, uint8_t *, size_t, bool);
+static int ssdfb_spi_xfer_rect_4wire_ssd1322(void *, uint8_t, uint8_t,
+ uint8_t, uint8_t, uint8_t *, size_t, bool);
+
+static void ssdfb_bitstream_init(struct bs_state *, uint8_t *);
+static void ssdfb_bitstream_append(struct bs_state *, uint8_t, uint8_t);
+static void ssdfb_bitstream_append_cmd(struct bs_state *, uint8_t);
+static void ssdfb_bitstream_append_data(struct bs_state *, uint8_t *,
+ size_t);
+static void ssdfb_bitstream_final(struct bs_state *);
+
+CFATTACH_DECL_NEW(ssdfb_spi, sizeof(struct ssdfb_spi_softc),
+ ssdfb_spi_match, ssdfb_spi_attach, NULL, NULL);
+
+static int
+ssdfb_spi_match(device_t parent, cfdata_t match, void *aux)
+{
+ struct spi_attach_args *sa = aux;
+
+ /*
+ * SSD1306 and SSD1322 data sheets specify 100ns cycle time.
+ */
+ if (spi_configure(sa->sa_handle, SPI_MODE_0, 10000000))
+ return 0;
+
+ return 1;
+}
+
+static void
+ssdfb_spi_attach(device_t parent, device_t self, void *aux)
+{
+ struct ssdfb_spi_softc *sc = device_private(self);
+ struct cfdata *cf = device_cfdata(self);
+ struct spi_attach_args *sa = aux;
+ int flags = cf->cf_flags;
+
+ sc->sc.sc_dev = self;
+ sc->sc_sh = sa->sa_handle;
+ sc->sc.sc_cookie = (void *)sc;
+ if ((flags & SSDFB_ATTACH_FLAG_PRODUCT_MASK) == SSDFB_PRODUCT_UNKNOWN)
+ flags |= SSDFB_PRODUCT_SSD1322_GENERIC;
+ /*
+ * Note on interface modes.
+ *
+ * 3 wire mode sends 9 bit sequences over the MOSI, MSB contains
+ * the bit that determines if the lower 8 bits are command or data.
+ *
+ * 4 wire mode sends 8 bit sequences and requires an auxiliary GPIO
+ * pin for the command/data bit. But in other to allocate a GPIO pin
+ * we need to use fdt, so only support 3 wire mode in this frontend,
+ * at least for now.
+ */
+ sc->sc_3wiremode = true;
+
+ switch (flags & SSDFB_ATTACH_FLAG_PRODUCT_MASK) {
+ case SSDFB_PRODUCT_SSD1322_GENERIC:
+ if (sc->sc_3wiremode) {
+ sc->sc.sc_transfer_rect =
+ ssdfb_spi_xfer_rect_3wire_ssd1322;
+ } else {
+ sc->sc.sc_transfer_rect =
+ ssdfb_spi_xfer_rect_4wire_ssd1322;
+ }
+ break;
+ default:
+ panic("ssdfb_spi_attach: product not implemented");
+ }
+ if (sc->sc_3wiremode) {
+ sc->sc.sc_cmd = ssdfb_spi_cmd_3wire;
+ } else {
+ sc->sc.sc_cmd = ssdfb_spi_cmd_4wire;
+ }
+
+ ssdfb_attach(&sc->sc, flags);
+
+ device_printf(sc->sc.sc_dev, "%d-wire SPI interface\n",
+ sc->sc_3wiremode == true ? 3 : 4);
+}
+
+static int
+ssdfb_spi_cmd_3wire(void *cookie, uint8_t *cmd, size_t len, bool usepoll)
+{
+ struct ssdfb_spi_softc *sc = (struct ssdfb_spi_softc *)cookie;
+ uint8_t bitstream[16 * 9 / 8];
+ struct bs_state s;
+
+ KASSERT(len > 0 && len <= 16);
+ ssdfb_bitstream_init(&s, bitstream);
+ ssdfb_bitstream_append_cmd(&s, *cmd);
+ cmd++;
+ len--;
+ ssdfb_bitstream_append_data(&s, cmd, len);
+ ssdfb_bitstream_final(&s);
+
+ return spi_send(sc->sc_sh, s.cur - s.base, bitstream);
+}
+
+static int
+ssdfb_spi_xfer_rect_3wire_ssd1322(void *cookie, uint8_t fromcol, uint8_t tocol,
+ uint8_t fromrow, uint8_t torow, uint8_t *p, size_t stride, bool usepoll)
+{
+ struct ssdfb_spi_softc *sc = (struct ssdfb_spi_softc *)cookie;
+ uint8_t bitstream[128 * 9 / 8];
+ struct bs_state s;
+ uint8_t row;
+ size_t rlen = (tocol + 1 - fromcol) * 2;
+ int error;
+
+ /*
+ * Unlike iic(4), there is no way to force spi(4) to use polling.
+ */
+ if (usepoll || cold)
+ return 0;
+
+ ssdfb_bitstream_init(&s, bitstream);
+ ssdfb_bitstream_append_cmd(&s, SSD1322_CMD_SET_ROW_ADDRESS);
+ ssdfb_bitstream_append_data(&s, &fromrow, 1);
+ ssdfb_bitstream_append_data(&s, &torow, 1);
+ ssdfb_bitstream_append_cmd(&s, SSD1322_CMD_SET_COLUMN_ADDRESS);
+ ssdfb_bitstream_append_data(&s, &fromcol, 1);
+ ssdfb_bitstream_append_data(&s, &tocol, 1);
+ ssdfb_bitstream_append_cmd(&s, SSD1322_CMD_WRITE_RAM);
+ ssdfb_bitstream_final(&s);
+ error = spi_send(sc->sc_sh, s.cur - s.base, bitstream);
+ if (error)
+ return error;
+
+ KASSERT(rlen <= 128);
+ for (row = fromrow; row <= torow; row++) {
+ ssdfb_bitstream_init(&s, bitstream);
+ ssdfb_bitstream_append_data(&s, p, rlen);
+ ssdfb_bitstream_final(&s);
+ error = spi_send(sc->sc_sh, s.cur - s.base, bitstream);
+ if (error)
+ return error;
+ p += stride;
+ }
+
+ return 0;
+}
+
+static void
+ssdfb_bitstream_init(struct bs_state *s, uint8_t *dst)
+{
+ s->base = s->cur = dst;
+ s->mask = 0x80;
+}
+
+static void
+ssdfb_bitstream_append(struct bs_state *s, uint8_t b, uint8_t srcmask)
+{
+ while(srcmask) {
+ if (b & srcmask)
+ *s->cur |= s->mask;
+ else
+ *s->cur &= ~s->mask;
+ srcmask >>= 1;
+ s->mask >>= 1;
+ if (!s->mask) {
+ s->mask = 0x80;
+ s->cur++;
+ }
+ }
+}
+
+static void
+ssdfb_bitstream_append_cmd(struct bs_state *s, uint8_t cmd)
+{
+ ssdfb_bitstream_append(s, 0, 1);
+ ssdfb_bitstream_append(s, cmd, 0x80);
+}
+
+static void
+ssdfb_bitstream_append_data(struct bs_state *s, uint8_t *data, size_t len)
+{
+ while(len--) {
+ ssdfb_bitstream_append(s, 1, 1);
+ ssdfb_bitstream_append(s, *data++, 0x80);
+ }
+}
+
+static void
+ssdfb_bitstream_final(struct bs_state *s)
+{
+ uint8_t padding_cmd = SSD1322_CMD_WRITE_RAM;
+ /* padding_cmd = SSDFB_NOP_CMD; */
+
+ while (s->mask != 0x80) {
+ ssdfb_bitstream_append_cmd(s, padding_cmd);
+ }
+}
+
+static void
+ssdfb_spi_4wire_set_dc(struct ssdfb_spi_softc *sc, int value)
+{
+ /* TODO: this should toggle an auxilliary GPIO pin */
+ panic("ssdfb_spi_4wire_set_dc");
+}
+
+static int
+ssdfb_spi_cmd_4wire(void *cookie, uint8_t *cmd, size_t len, bool usepoll)
+{
+ struct ssdfb_spi_softc *sc = (struct ssdfb_spi_softc *)cookie;
+ int error;
+
+ ssdfb_spi_4wire_set_dc(sc, 0);
+ error = spi_send(sc->sc_sh, 1, cmd);
+ if (error)
+ return error;
+ if (len > 1) {
+ ssdfb_spi_4wire_set_dc(sc, 1);
+ len--;
+ cmd++;
+ error = spi_send(sc->sc_sh, len, cmd);
+ if (error)
Home |
Main Index |
Thread Index |
Old Index