1 files changed, 122 insertions, 0 deletions
diff --git a/src/dev/virtio/console.cc b/src/dev/virtio/console.cc
new file mode 100644
index 000000000..70b53c185
--- /dev/null
+++ b/src/dev/virtio/console.cc
@@ -0,0 +1,122 @@
+/*
+ * Copyright (c) 2014 ARM Limited
+ * All rights reserved
+ *
+ * The license below extends only to copyright in the software and shall
+ * not be construed as granting a license to any other intellectual
+ * property including but not limited to intellectual property relating
+ * to a hardware implementation of the functionality of the software
+ * licensed hereunder.  You may use the software subject to the license
+ * terms below provided that you ensure that this notice is replicated
+ * unmodified and in its entirety in all distributions of the software,
+ * modified or unmodified, in source code or in binary form.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are
+ * met: redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer;
+ * 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;
+ * neither the name of the copyright holders nor the names of its
+ * contributors may be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * 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
+ * OWNER 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.
+ *
+ * Authors: Andreas Sandberg
+ */
+
+#include "debug/VIOConsole.hh"
+#include "dev/virtio/console.hh"
+#include "params/VirtIOConsole.hh"
+#include "sim/system.hh"
+
+
+VirtIOConsole::VirtIOConsole(Params *params)
+    : VirtIODeviceBase(params, ID_CONSOLE, sizeof(Config), F_SIZE),
+      qRecv(params->system->physProxy, params->qRecvSize, *this),
+      qTrans(params->system->physProxy, params->qTransSize, *this),
+      term(*params->terminal), callbackDataAvail(qRecv)
+{
+    registerQueue(qRecv);
+    registerQueue(qTrans);
+
+    config.cols = 80;
+    config.rows = 24;
+
+    term.regDataAvailCallback(&callbackDataAvail);
+}
+
+
+VirtIOConsole::~VirtIOConsole()
+{
+}
+void
+VirtIOConsole::readConfig(PacketPtr pkt, Addr cfgOffset)
+{
+    Config cfg_out;
+    cfg_out.rows = htov_legacy(config.rows);
+    cfg_out.cols = htov_legacy(config.cols);
+
+    readConfigBlob(pkt, cfgOffset, (uint8_t *)&cfg_out);
+}
+
+void
+VirtIOConsole::TermRecvQueue::trySend()
+{
+    DPRINTF(VIOConsole, "trySend\n");
+
+    // Send data as long as the terminal has outgoing data and we can
+    // get free descriptors (i.e., there are buffers available to
+    // send) from the guest.
+    VirtDescriptor *d;
+    while (parent.term.dataAvailable() && (d = consumeDescriptor())) {
+        DPRINTF(VIOConsole, "Got descriptor (len: %i)\n", d->size());
+        size_t len(0);
+        while (parent.term.dataAvailable() && len < d->size()) {
+            uint8_t in(parent.term.in());
+            d->chainWrite(len, &in, sizeof(uint8_t));
+            ++len;
+        }
+
+        // Tell the guest that we are done with this descriptor.
+        produceDescriptor(d, len);
+        parent.kick();
+    }
+}
+
+void
+VirtIOConsole::TermTransQueue::onNotifyDescriptor(VirtDescriptor *desc)
+{
+    DPRINTF(VIOConsole, "Got input data descriptor (len: %i)\n",
+            desc->size());
+
+    // Copy the data from the guest and forward it to the
+    // terminal.
+    const size_t size(desc->chainSize());
+    uint8_t data[size];
+    desc->chainRead(0, data, size);
+    for (int i = 0; i < desc->size(); ++i)
+        parent.term.out(data[i]);
+
+    // Tell the guest that we are done with this descriptor.
+    produceDescriptor(desc, 0);
+    parent.kick();
+}
+
+VirtIOConsole *
+VirtIOConsoleParams::create()
+{
+    return new VirtIOConsole(this);
+}