Current-Users archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
Re: Virtio Viocon driver - possible to backport from OpenBSD?
The attached patch adds viocon(4) to NetBSD. Lightly tested under
qemu. Review welcome! I'm not very familiar with tty drivers so I'm
hoping someone who is will take a look and see if I did anything the
wrong way in copying from OpenBSD.
As in OpenBSD, it uses new device nodes /dev/ttyVI[0-9][0-9], where
the first digit is the unit number and the second digit is the port
number. The port number is currently always zero but in principle it
might change. These are now unconditionally included in the MI
MAKEDEV.tmpl, and ttyVI00 through ttyVI30 are created by default.
From 50c5c4d195f82ad7b665a7e0adfa922a448e9cfb Mon Sep 17 00:00:00 2001
From: Taylor R Campbell <riastradh%NetBSD.org@localhost>
Date: Tue, 9 Aug 2022 14:09:38 +0000
Subject: [PATCH] viocon(4): New virtio tty driver imported from OpenBSD.
viocon* at virtio?
Tested under qemu with:
qemu-system-aarch64 ... \
-device virtio-serial \
-chardev socket,path=/tmp/ttyVI00,server=on,wait=off,id=ttyVI00 \
-device virtconsole,chardev=ttyVI00,name=org.NetBSD.dev.ttyVI00 \
...
---
distrib/sets/lists/man/mi | 3 +
etc/MAKEDEV.tmpl | 9 +
share/man/man4/Makefile | 2 +-
share/man/man4/viocon.4 | 66 ++++
sys/conf/majors | 1 +
sys/dev/virtio/files.virtio | 4 +
sys/dev/virtio/viocon.c | 632 ++++++++++++++++++++++++++++++++++++
7 files changed, 716 insertions(+), 1 deletion(-)
create mode 100644 share/man/man4/viocon.4
create mode 100644 sys/dev/virtio/viocon.c
diff --git a/distrib/sets/lists/man/mi b/distrib/sets/lists/man/mi
index 3b354d653ca0..c56263b6dffc 100644
--- a/distrib/sets/lists/man/mi
+++ b/distrib/sets/lists/man/mi
@@ -2047,6 +2047,7 @@
./usr/share/man/cat4/video.0 man-sys-catman .cat
./usr/share/man/cat4/vinum.0 man-obsolete obsolete
./usr/share/man/cat4/vio9p.0 man-sys-catman .cat
+./usr/share/man/cat4/viocon.0 man-sys-catman .cat
./usr/share/man/cat4/vioif.0 man-sys-catman .cat
./usr/share/man/cat4/viomb.0 man-sys-catman .cat
./usr/share/man/cat4/viornd.0 man-sys-catman .cat
@@ -5233,6 +5234,7 @@
./usr/share/man/html4/viaide.html man-sys-htmlman html
./usr/share/man/html4/video.html man-sys-htmlman html
./usr/share/man/html4/vio9p.html man-sys-htmlman html
+./usr/share/man/html4/viocon.html man-sys-htmlman html
./usr/share/man/html4/vioif.html man-sys-htmlman html
./usr/share/man/html4/viomb.html man-sys-htmlman html
./usr/share/man/html4/viornd.html man-sys-htmlman html
@@ -8351,6 +8353,7 @@
./usr/share/man/man4/video.4 man-sys-man .man
./usr/share/man/man4/vinum.4 man-obsolete obsolete
./usr/share/man/man4/vio9p.4 man-sys-man .man
+./usr/share/man/man4/viocon.4 man-sys-man .man
./usr/share/man/man4/vioif.4 man-sys-man .man
./usr/share/man/man4/viomb.4 man-sys-man .man
./usr/share/man/man4/viornd.4 man-sys-man .man
diff --git a/etc/MAKEDEV.tmpl b/etc/MAKEDEV.tmpl
index 51fb821f244b..6576679045a8 100644
--- a/etc/MAKEDEV.tmpl
+++ b/etc/MAKEDEV.tmpl
@@ -148,6 +148,7 @@
# dmz* UNIBUS DMZ32 (vax)
# dl* UNIBUS DL11 (vax)
# xencons Xen virtual console
+# ttyVI?? viocon(4)
#
# Terminal multiplexors:
# dc* 4 channel serial interface (keyboard, mouse, modem, printer)
@@ -849,6 +850,7 @@ all)
makedev qemufwcfg
makedev sht3xtemp0
makedev scmd0
+ makedev ttyVI00 ttyVI10 ttyVI20 ttyVI30
makedev local # do this last
;;
@@ -2272,6 +2274,13 @@ scmd[0-9]*)
mkdev scmd$unit c %scmd_chr% $unit 666
;;
+ttyVI[0-9][0-9])
+ port=${i#ttyVI?}
+ devunit=${i%$port}
+ unit=${devunit#ttyVI}
+ mkdev ttyVI$unit$port c %viocon_chr% $((16*$unit + $port))
+ ;;
+
midevend)
%MI_DEVICES_END%
local)
diff --git a/share/man/man4/Makefile b/share/man/man4/Makefile
index d98073dccd63..897dca9ebd64 100644
--- a/share/man/man4/Makefile
+++ b/share/man/man4/Makefile
@@ -68,7 +68,7 @@ MAN= aac.4 ac97.4 acardide.4 aceride.4 acphy.4 \
uark.4 ubsec.4 udp.4 uep.4 ug.4 uha.4 uk.4 ukphy.4 umb.4 \
unix.4 userconf.4 \
vald.4 valz.4 veriexec.4 vga.4 vge.4 viaide.4 video.4 \
- vio9p.4 vioif.4 viomb.4 viornd.4 vioscsi.4 virt.4 virtio.4 \
+ vio9p.4 viocon.4 vioif.4 viomb.4 viornd.4 vioscsi.4 virt.4 virtio.4 \
vether.4 vlan.4 vmmon.4 vmnet.4 vmt.4 vmx.4 vnd.4 voodoofb.4 vr.4 \
vte.4 \
wapbl.4 wb.4 wbsio.4 wd.4 wdc.4 wg.4 wi.4 wm.4 wpi.4 \
diff --git a/share/man/man4/viocon.4 b/share/man/man4/viocon.4
new file mode 100644
index 000000000000..e9946d0e124b
--- /dev/null
+++ b/share/man/man4/viocon.4
@@ -0,0 +1,66 @@
+.\" $NetBSD$
+.\" $OpenBSD: viocon.4,v 1.3 2017/06/21 08:21:14 akfaew Exp $
+.\"
+.\" Copyright (c) 2015 Stefan Fritsch <sf%sfritsch.de@localhost>
+.\"
+.\" Permission to use, copy, modify, and distribute this software for any
+.\" purpose with or without fee is hereby granted, provided that the above
+.\" copyright notice and this permission notice appear in all copies.
+.\"
+.\" THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+.\" WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+.\" MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+.\" ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+.\" WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+.\" ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+.\" OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+.\"
+.Dd $Mdocdate: June 21 2017 $
+.Dt VIOCON 4
+.Os
+.Sh NAME
+.Nm viocon
+.Nd VirtIO console device
+.Sh SYNOPSIS
+.Cd "viocon* at virtio?"
+.Sh DESCRIPTION
+The
+.Nm
+driver provides support for the
+.Xr virtio 4
+console interface provided by KVM, QEMU, and others.
+.Pp
+It provides serial ports that are attached as ttys.
+.Sh FILES
+.Bl -tag -width Pa -compact
+.It Pa /dev/ttyVI00
+.It Pa /dev/ttyVI10
+.It Pa /dev/ttyVI20
+.It Pa /dev/ttyVI30
+.It Pa /dev/ttyVI40
+.El
+.Sh SEE ALSO
+.Xr intro 4 ,
+.Xr tty 4 ,
+.Xr virtio 4
+.Sh HISTORY
+The
+.Nm
+driver first appeared in
+.Ox 5.9 .
+.Sh AUTHORS
+.An -nosplit
+The
+.Nm
+driver was written for
+.Ox
+by
+.An Stefan Fritsch Aq Mt sf%sfritsch.de@localhost .
+It was ported to
+.Nx 10.0 .
+.Sh BUGS
+Use as a kernel console for
+.Nx
+is not yet supported.
+.Pp
+The multiport feature is not yet supported.
diff --git a/sys/conf/majors b/sys/conf/majors
index 6498bc46a246..2aaaf847d117 100644
--- a/sys/conf/majors
+++ b/sys/conf/majors
@@ -95,3 +95,4 @@ device-major smbios char 360 smbios
device-major efi char 361 efi
device-major sht3xtemp char 362 sht3xtemp
device-major scmd char 363 scmd
+device-major viocon char 364 viocon
diff --git a/sys/dev/virtio/files.virtio b/sys/dev/virtio/files.virtio
index 4477ce08634f..88490ccb47b0 100644
--- a/sys/dev/virtio/files.virtio
+++ b/sys/dev/virtio/files.virtio
@@ -4,3 +4,7 @@
include "dev/pci/files.virtio"
file dev/virtio/virtio_mmio.c virtio_mmio
+
+device viocon
+attach viocon at virtio
+file dev/virtio/viocon.c viocon
diff --git a/sys/dev/virtio/viocon.c b/sys/dev/virtio/viocon.c
new file mode 100644
index 000000000000..3520395aadd5
--- /dev/null
+++ b/sys/dev/virtio/viocon.c
@@ -0,0 +1,632 @@
+/* $NetSBD$ */
+/* $OpenBSD: viocon.c,v 1.8 2021/11/05 11:38:29 mpi Exp $ */
+
+/*
+ * Copyright (c) 2013-2015 Stefan Fritsch <sf%sfritsch.de@localhost>
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD$");
+
+#include <sys/param.h>
+#include <sys/types.h>
+
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/device.h>
+#include <sys/kauth.h>
+#include <sys/kernel.h>
+#include <sys/kmem.h>
+#include <sys/lwp.h>
+#include <sys/systm.h>
+#include <sys/tty.h>
+
+#include <dev/pci/virtioreg.h>
+#include <dev/pci/virtiovar.h>
+
+#include "ioconf.h"
+
+/* OpenBSD compat shims */
+#define ttymalloc(speed) tty_alloc()
+#define splassert(ipl) __nothing
+#define virtio_notify(vsc, vq) virtio_enqueue_commit(vsc, vq, -1, true)
+#define ttwakeupwr(tp) __nothing
+
+/* features */
+#define VIRTIO_CONSOLE_F_SIZE (1ULL<<0)
+#define VIRTIO_CONSOLE_F_MULTIPORT (1ULL<<1)
+#define VIRTIO_CONSOLE_F_EMERG_WRITE (1ULL<<2)
+
+/* config space */
+#define VIRTIO_CONSOLE_COLS 0 /* 16 bits */
+#define VIRTIO_CONSOLE_ROWS 2 /* 16 bits */
+#define VIRTIO_CONSOLE_MAX_NR_PORTS 4 /* 32 bits */
+#define VIRTIO_CONSOLE_EMERG_WR 8 /* 32 bits */
+
+#define VIOCON_DEBUG 0
+
+#if VIOCON_DEBUG
+#define DPRINTF(x...) printf(x)
+#else
+#define DPRINTF(x...)
+#endif
+
+#define VIRTIO_CONSOLE_FLAG_BITS \
+ VIRTIO_COMMON_FLAG_BITS \
+ "b\x00" "SIZE\0" \
+ "b\x01" "MULTIPORT\0" \
+ "b\x02" "EMERG_WRITE\0"
+
+struct virtio_console_control {
+ uint32_t id; /* Port number */
+
+#define VIRTIO_CONSOLE_DEVICE_READY 0
+#define VIRTIO_CONSOLE_PORT_ADD 1
+#define VIRTIO_CONSOLE_PORT_REMOVE 2
+#define VIRTIO_CONSOLE_PORT_READY 3
+#define VIRTIO_CONSOLE_CONSOLE_PORT 4
+#define VIRTIO_CONSOLE_RESIZE 5
+#define VIRTIO_CONSOLE_PORT_OPEN 6
+#define VIRTIO_CONSOLE_PORT_NAME 7
+ uint16_t event;
+
+ uint16_t value;
+};
+
+struct virtio_console_control_resize {
+ /* yes, the order is different than in config space */
+ uint16_t rows;
+ uint16_t cols;
+};
+
+#define BUFSIZE 128
+
+#define VIOCONUNIT(x) (minor(x) >> 4)
+#define VIOCONPORT(x) (minor(x) & 0x0f)
+
+struct viocon_port {
+ struct viocon_softc *vp_sc;
+ struct virtqueue *vp_rx;
+ struct virtqueue *vp_tx;
+ void *vp_si;
+ struct tty *vp_tty;
+ const char *vp_name;
+ bus_dma_segment_t vp_dmaseg;
+ bus_dmamap_t vp_dmamap;
+#ifdef NOTYET
+ unsigned int vp_host_open:1; /* XXX needs F_MULTIPORT */
+ unsigned int vp_guest_open:1; /* XXX needs F_MULTIPORT */
+ unsigned int vp_is_console:1; /* XXX needs F_MULTIPORT */
+#endif
+ unsigned int vp_iflow:1; /* rx flow control */
+ uint16_t vp_rows;
+ uint16_t vp_cols;
+ u_char *vp_rx_buf;
+ u_char *vp_tx_buf;
+};
+
+struct viocon_softc {
+ struct device *sc_dev;
+ struct virtio_softc *sc_virtio;
+ struct virtqueue *sc_vqs;
+
+ struct virtqueue *sc_c_vq_rx;
+ struct virtqueue *sc_c_vq_tx;
+
+ unsigned int sc_max_ports;
+ struct viocon_port **sc_ports;
+
+ bus_dmamap_t sc_dmamap;
+};
+
+int viocon_match(struct device *, struct cfdata *, void *);
+void viocon_attach(struct device *, struct device *, void *);
+int viocon_tx_intr(struct virtqueue *);
+int viocon_tx_drain(struct viocon_port *, struct virtqueue *vq);
+int viocon_rx_intr(struct virtqueue *);
+void viocon_rx_soft(void *);
+void viocon_rx_fill(struct viocon_port *);
+int viocon_port_create(struct viocon_softc *, int);
+void vioconstart(struct tty *);
+int vioconhwiflow(struct tty *, int);
+int vioconparam(struct tty *, struct termios *);
+int vioconopen(dev_t, int, int, struct lwp *);
+int vioconclose(dev_t, int, int, struct lwp *);
+int vioconread(dev_t, struct uio *, int);
+int vioconwrite(dev_t, struct uio *, int);
+void vioconstop(struct tty *, int);
+int vioconioctl(dev_t, u_long, void *, int, struct lwp *);
+struct tty *viocontty(dev_t dev);
+
+CFATTACH_DECL_NEW(viocon, sizeof(struct viocon_softc),
+ viocon_match, viocon_attach, /*detach*/NULL, /*activate*/NULL);
+
+const struct cdevsw viocon_cdevsw = {
+ .d_open = vioconopen,
+ .d_close = vioconclose,
+ .d_read = vioconread,
+ .d_write = vioconwrite,
+ .d_ioctl = vioconioctl,
+ .d_stop = vioconstop,
+ .d_tty = viocontty,
+ .d_poll = nopoll, /* XXX */
+ .d_mmap = nommap,
+ .d_kqfilter = ttykqfilter,
+ .d_discard = nodiscard,
+ .d_flag = D_TTY,
+};
+
+static inline struct viocon_softc *
+dev2sc(dev_t dev)
+{
+ return device_lookup_private(&viocon_cd, VIOCONUNIT(dev));
+}
+
+static inline struct viocon_port *
+dev2port(dev_t dev)
+{
+ return dev2sc(dev)->sc_ports[VIOCONPORT(dev)];
+}
+
+int viocon_match(struct device *parent, struct cfdata *match, void *aux)
+{
+ struct virtio_attach_args *va = aux;
+ if (va->sc_childdevid == VIRTIO_DEVICE_ID_CONSOLE)
+ return 1;
+ return 0;
+}
+
+void
+viocon_attach(struct device *parent, struct device *self, void *aux)
+{
+ struct viocon_softc *sc = device_private(self);
+ struct virtio_softc *vsc = device_private(parent);
+ int maxports = 1;
+
+ sc->sc_dev = self;
+ if (virtio_child(vsc) != NULL) {
+ aprint_error(": parent %s already has a child\n",
+ device_xname(parent));
+ return;
+ }
+ sc->sc_virtio = vsc;
+ sc->sc_max_ports = maxports;
+
+ sc->sc_vqs = kmem_zalloc(2 * (maxports + 1) * sizeof(sc->sc_vqs[0]),
+ KM_SLEEP);
+ sc->sc_ports = kmem_zalloc(maxports * sizeof(sc->sc_ports[0]),
+ KM_SLEEP);
+
+ virtio_child_attach_start(vsc, self, IPL_TTY, sc->sc_vqs,
+ /*config_change*/NULL, virtio_vq_intr,
+ /*req_flags*/0, /*req_features*/VIRTIO_CONSOLE_F_SIZE,
+ VIRTIO_CONSOLE_FLAG_BITS);
+
+ DPRINTF("%s: softc: %p\n", __func__, sc);
+ if (viocon_port_create(sc, 0) != 0) {
+ printf("\n%s: viocon_port_create failed\n", __func__);
+ goto err;
+ }
+ viocon_rx_fill(sc->sc_ports[0]);
+
+ if (virtio_child_attach_finish(vsc) != 0)
+ goto err;
+
+ return;
+err:
+ kmem_free(sc->sc_vqs, 2 * (maxports + 1) * sizeof(sc->sc_vqs[0]));
+ kmem_free(sc->sc_ports, maxports * sizeof(sc->sc_ports[0]));
+ virtio_child_attach_failed(vsc);
+}
+
+int
+viocon_port_create(struct viocon_softc *sc, int portidx)
+{
+ struct virtio_softc *vsc = sc->sc_virtio;
+ int rxidx, txidx, allocsize, nsegs;
+ char name[6];
+ struct viocon_port *vp;
+ void *kva;
+ struct tty *tp;
+
+ vp = kmem_zalloc(sizeof(*vp), KM_SLEEP);
+ if (vp == NULL)
+ return ENOMEM;
+ sc->sc_ports[portidx] = vp;
+ vp->vp_sc = sc;
+ DPRINTF("%s: vp: %p\n", __func__, vp);
+
+ if (portidx == 0)
+ rxidx = 0;
+ else
+ rxidx = 2 * (portidx + 1);
+ txidx = rxidx + 1;
+
+ snprintf(name, sizeof(name), "p%drx", portidx);
+ if (virtio_alloc_vq(vsc, &sc->sc_vqs[rxidx], rxidx, BUFSIZE, 1,
+ name) != 0) {
+ printf("\nCan't alloc %s virtqueue\n", name);
+ goto err;
+ }
+ vp->vp_rx = &sc->sc_vqs[rxidx];
+ vp->vp_rx->vq_done = viocon_rx_intr;
+ vp->vp_si = softint_establish(SOFTINT_SERIAL, viocon_rx_soft, vp);
+ DPRINTF("%s: rx: %p\n", __func__, vp->vp_rx);
+
+ snprintf(name, sizeof(name), "p%dtx", portidx);
+ if (virtio_alloc_vq(vsc, &sc->sc_vqs[txidx], txidx, BUFSIZE, 1,
+ name) != 0) {
+ printf("\nCan't alloc %s virtqueue\n", name);
+ goto err;
+ }
+ vp->vp_tx = &sc->sc_vqs[txidx];
+ vp->vp_tx->vq_done = viocon_tx_intr;
+ DPRINTF("%s: tx: %p\n", __func__, vp->vp_tx);
+
+ allocsize = (vp->vp_rx->vq_num + vp->vp_tx->vq_num) * BUFSIZE;
+
+ if (bus_dmamap_create(virtio_dmat(vsc), allocsize, 1, allocsize, 0,
+ BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &vp->vp_dmamap) != 0)
+ goto err;
+ if (bus_dmamem_alloc(virtio_dmat(vsc), allocsize, 8, 0, &vp->vp_dmaseg,
+ 1, &nsegs, BUS_DMA_NOWAIT) != 0)
+ goto err;
+ if (bus_dmamem_map(virtio_dmat(vsc), &vp->vp_dmaseg, nsegs,
+ allocsize, &kva, BUS_DMA_NOWAIT) != 0)
+ goto err;
+ memset(kva, 0, allocsize);
+ if (bus_dmamap_load(virtio_dmat(vsc), vp->vp_dmamap, kva,
+ allocsize, NULL, BUS_DMA_NOWAIT) != 0)
+ goto err;
+ vp->vp_rx_buf = (unsigned char *)kva;
+ /*
+ * XXX use only a small circular tx buffer instead of many BUFSIZE buffers?
+ */
+ vp->vp_tx_buf = vp->vp_rx_buf + vp->vp_rx->vq_num * BUFSIZE;
+
+ if (virtio_features(vsc) & VIRTIO_CONSOLE_F_SIZE) {
+ vp->vp_cols = virtio_read_device_config_2(vsc,
+ VIRTIO_CONSOLE_COLS);
+ vp->vp_rows = virtio_read_device_config_2(vsc,
+ VIRTIO_CONSOLE_ROWS);
+ }
+
+ tp = ttymalloc(1000000);
+ tp->t_oproc = vioconstart;
+ tp->t_param = vioconparam;
+ tp->t_hwiflow = vioconhwiflow;
+ tp->t_dev = (device_unit(sc->sc_dev) << 4) | portidx;
+ vp->vp_tty = tp;
+ DPRINTF("%s: tty: %p\n", __func__, tp);
+
+ virtio_start_vq_intr(vsc, vp->vp_rx);
+ virtio_start_vq_intr(vsc, vp->vp_tx);
+
+ return 0;
+err:
+ panic("%s failed", __func__);
+ return -1;
+}
+
+int
+viocon_tx_drain(struct viocon_port *vp, struct virtqueue *vq)
+{
+ struct virtio_softc *vsc = vq->vq_owner;
+ int ndone = 0, len, slot;
+
+ splassert(IPL_TTY);
+ while (virtio_dequeue(vsc, vq, &slot, &len) == 0) {
+ bus_dmamap_sync(virtio_dmat(vsc), vp->vp_dmamap,
+ vp->vp_tx_buf - vp->vp_rx_buf + slot * BUFSIZE, BUFSIZE,
+ BUS_DMASYNC_POSTREAD);
+ virtio_dequeue_commit(vsc, vq, slot);
+ ndone++;
+ }
+ return ndone;
+}
+
+int
+viocon_tx_intr(struct virtqueue *vq)
+{
+ struct virtio_softc *vsc = vq->vq_owner;
+ struct viocon_softc *sc = device_private(virtio_child(vsc));
+ int ndone = 0;
+ int portidx = (vq->vq_index - 1) / 2;
+ struct viocon_port *vp = sc->sc_ports[portidx];
+ struct tty *tp = vp->vp_tty;
+
+ splassert(IPL_TTY);
+ ndone = viocon_tx_drain(vp, vq);
+ if (ndone && ISSET(tp->t_state, TS_BUSY)) {
+ CLR(tp->t_state, TS_BUSY);
+ (*tp->t_linesw->l_start)(tp);
+ }
+
+ return 1;
+}
+
+void
+viocon_rx_fill(struct viocon_port *vp)
+{
+ struct virtqueue *vq = vp->vp_rx;
+ struct virtio_softc *vsc = vp->vp_sc->sc_virtio;
+ int r, slot, ndone = 0;
+
+ while ((r = virtio_enqueue_prep(vsc, vq, &slot)) == 0) {
+ if (virtio_enqueue_reserve(vsc, vq, slot, 1) != 0)
+ break;
+ bus_dmamap_sync(virtio_dmat(vsc), vp->vp_dmamap, slot * BUFSIZE,
+ BUFSIZE, BUS_DMASYNC_PREREAD);
+ virtio_enqueue_p(vsc, vq, slot, vp->vp_dmamap, slot * BUFSIZE,
+ BUFSIZE, 0);
+ virtio_enqueue_commit(vsc, vq, slot, 0);
+ ndone++;
+ }
+ KASSERT(r == 0 || r == EAGAIN);
+ if (ndone > 0)
+ virtio_notify(vsc, vq);
+}
+
+int
+viocon_rx_intr(struct virtqueue *vq)
+{
+ struct virtio_softc *vsc = vq->vq_owner;
+ struct viocon_softc *sc = device_private(virtio_child(vsc));
+ int portidx = (vq->vq_index - 1) / 2;
+ struct viocon_port *vp = sc->sc_ports[portidx];
+
+ softint_schedule(vp->vp_si);
+ return 1;
+}
+
+void
+viocon_rx_soft(void *arg)
+{
+ struct viocon_port *vp = arg;
+ struct virtqueue *vq = vp->vp_rx;
+ struct virtio_softc *vsc = vq->vq_owner;
+ struct tty *tp = vp->vp_tty;
+ int slot, len, i;
+ u_char *p;
+
+ while (!vp->vp_iflow && virtio_dequeue(vsc, vq, &slot, &len) == 0) {
+ bus_dmamap_sync(virtio_dmat(vsc), vp->vp_dmamap,
+ slot * BUFSIZE, BUFSIZE, BUS_DMASYNC_POSTREAD);
+ p = vp->vp_rx_buf + slot * BUFSIZE;
+ for (i = 0; i < len; i++)
+ (*tp->t_linesw->l_rint)(*p++, tp);
+ virtio_dequeue_commit(vsc, vq, slot);
+ }
+
+ viocon_rx_fill(vp);
+
+ return;
+}
+
+void
+vioconstart(struct tty *tp)
+{
+ struct viocon_softc *sc = dev2sc(tp->t_dev);
+ struct virtio_softc *vsc;
+ struct viocon_port *vp = dev2port(tp->t_dev);
+ struct virtqueue *vq;
+ u_char *buf;
+ int s, cnt, slot, ret, ndone;
+
+ vsc = sc->sc_virtio;
+ vq = vp->vp_tx;
+
+ s = spltty();
+
+ ndone = viocon_tx_drain(vp, vq);
+ if (ISSET(tp->t_state, TS_BUSY)) {
+ if (ndone > 0)
+ CLR(tp->t_state, TS_BUSY);
+ else
+ goto out;
+ }
+ if (ISSET(tp->t_state, TS_TIMEOUT | TS_TTSTOP))
+ goto out;
+
+ if (tp->t_outq.c_cc == 0)
+ goto out;
+ ndone = 0;
+
+ while (tp->t_outq.c_cc > 0) {
+ ret = virtio_enqueue_prep(vsc, vq, &slot);
+ if (ret == EAGAIN) {
+ SET(tp->t_state, TS_BUSY);
+ break;
+ }
+ KASSERT(ret == 0);
+ ret = virtio_enqueue_reserve(vsc, vq, slot, 1);
+ KASSERT(ret == 0);
+ buf = vp->vp_tx_buf + slot * BUFSIZE;
+ cnt = q_to_b(&tp->t_outq, buf, BUFSIZE);
+ bus_dmamap_sync(virtio_dmat(vsc), vp->vp_dmamap,
+ vp->vp_tx_buf - vp->vp_rx_buf + slot * BUFSIZE, cnt,
+ BUS_DMASYNC_PREWRITE);
+ virtio_enqueue_p(vsc, vq, slot, vp->vp_dmamap,
+ vp->vp_tx_buf - vp->vp_rx_buf + slot * BUFSIZE, cnt, 1);
+ virtio_enqueue_commit(vsc, vq, slot, 0);
+ ndone++;
+ }
+ if (ndone > 0)
+ virtio_notify(vsc, vq);
+ ttwakeupwr(tp);
+out:
+ splx(s);
+}
+
+int
+vioconhwiflow(struct tty *tp, int stop)
+{
+ struct viocon_port *vp = dev2port(tp->t_dev);
+ int s;
+
+ s = spltty();
+ vp->vp_iflow = stop;
+ if (stop) {
+ virtio_stop_vq_intr(vp->vp_sc->sc_virtio, vp->vp_rx);
+ } else {
+ virtio_start_vq_intr(vp->vp_sc->sc_virtio, vp->vp_rx);
+ softint_schedule(vp->vp_si);
+ }
+ splx(s);
+ return 1;
+}
+
+int
+vioconparam(struct tty *tp, struct termios *t)
+{
+ tp->t_ispeed = t->c_ispeed;
+ tp->t_ospeed = t->c_ospeed;
+ tp->t_cflag = t->c_cflag;
+
+ vioconstart(tp);
+ return 0;
+}
+
+int
+vioconopen(dev_t dev, int flag, int mode, struct lwp *l)
+{
+ int unit = VIOCONUNIT(dev);
+ int port = VIOCONPORT(dev);
+ struct viocon_softc *sc;
+ struct viocon_port *vp;
+ struct tty *tp;
+ int s, error;
+
+ sc = device_lookup_private(&viocon_cd, unit);
+ if (sc == NULL)
+ return (ENXIO);
+ if (!device_is_active(sc->sc_dev))
+ return (ENXIO);
+
+ s = spltty();
+ if (port >= sc->sc_max_ports) {
+ splx(s);
+ return (ENXIO);
+ }
+ vp = sc->sc_ports[port];
+ tp = vp->vp_tty;
+#ifdef NOTYET
+ vp->vp_guest_open = 1;
+#endif
+ splx(s);
+
+ if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
+ return (EBUSY);
+
+ s = spltty();
+ if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
+ ttychars(tp);
+ tp->t_ispeed = 1000000;
+ tp->t_ospeed = 1000000;
+ tp->t_cflag = TTYDEF_CFLAG|CLOCAL|CRTSCTS;
+ tp->t_iflag = TTYDEF_IFLAG;
+ tp->t_oflag = TTYDEF_OFLAG;
+ tp->t_lflag = TTYDEF_LFLAG;
+ if (vp->vp_cols != 0) {
+ tp->t_winsize.ws_col = vp->vp_cols;
+ tp->t_winsize.ws_row = vp->vp_rows;
+ }
+
+ vioconparam(tp, &tp->t_termios);
+ ttsetwater(tp);
+ }
+ splx(s);
+
+ error = (*tp->t_linesw->l_open)(dev, tp);
+ return error;
+}
+
+int
+vioconclose(dev_t dev, int flag, int mode, struct lwp *l)
+{
+ struct viocon_port *vp = dev2port(dev);
+ struct tty *tp = vp->vp_tty;
+ int s;
+
+ if (!ISSET(tp->t_state, TS_ISOPEN))
+ return 0;
+
+ (*tp->t_linesw->l_close)(tp, flag);
+ s = spltty();
+#ifdef NOTYET
+ vp->vp_guest_open = 0;
+#endif
+ CLR(tp->t_state, TS_BUSY | TS_FLUSH);
+ ttyclose(tp);
+ splx(s);
+
+ return 0;
+}
+
+int
+vioconread(dev_t dev, struct uio *uio, int flag)
+{
+ struct viocon_port *vp = dev2port(dev);
+ struct tty *tp = vp->vp_tty;
+
+ return (*tp->t_linesw->l_read)(tp, uio, flag);
+}
+
+int
+vioconwrite(dev_t dev, struct uio *uio, int flag)
+{
+ struct viocon_port *vp = dev2port(dev);
+ struct tty *tp = vp->vp_tty;
+
+ return (*tp->t_linesw->l_write)(tp, uio, flag);
+}
+
+struct tty *
+viocontty(dev_t dev)
+{
+ struct viocon_port *vp = dev2port(dev);
+
+ return vp->vp_tty;
+}
+
+void
+vioconstop(struct tty *tp, int flag)
+{
+ int s;
+
+ s = spltty();
+ if (ISSET(tp->t_state, TS_BUSY))
+ if (!ISSET(tp->t_state, TS_TTSTOP))
+ SET(tp->t_state, TS_FLUSH);
+ splx(s);
+}
+
+int
+vioconioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
+{
+ struct viocon_port *vp = dev2port(dev);
+ struct tty *tp;
+ int error1, error2;
+
+ tp = vp->vp_tty;
+
+ error1 = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
+ if (error1 >= 0)
+ return error1;
+ error2 = ttioctl(tp, cmd, data, flag, l);
+ if (error2 >= 0)
+ return error2;
+ return ENOTTY;
+}
Home |
Main Index |
Thread Index |
Old Index