From: Andreas Sandberg Date: Sat, 20 Sep 2014 21:17:52 +0000 (-0400) Subject: dev: Add a VirtIO console device model X-Git-Url: https://git.libre-soc.org/?a=commitdiff_plain;h=b8c9b04bd607877c69eb4eac3c00270025c2a5e4;p=gem5.git dev: Add a VirtIO console device model --- diff --git a/src/dev/virtio/SConscript b/src/dev/virtio/SConscript index d883d5ad8..2d4fb00dd 100644 --- a/src/dev/virtio/SConscript +++ b/src/dev/virtio/SConscript @@ -43,9 +43,12 @@ if env['TARGET_ISA'] == 'null': Return() SimObject('VirtIO.py') +SimObject('VirtIOConsole.py') Source('base.cc') Source('pci.cc') +Source('console.cc') DebugFlag('VIO', 'VirtIO base functionality') DebugFlag('VIOPci', 'VirtIO PCI transport') +DebugFlag('VIOConsole', 'VirtIO console device') diff --git a/src/dev/virtio/VirtIOConsole.py b/src/dev/virtio/VirtIOConsole.py new file mode 100644 index 000000000..cd73d6509 --- /dev/null +++ b/src/dev/virtio/VirtIOConsole.py @@ -0,0 +1,51 @@ +# -*- mode:python -*- + +# 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 + +from m5.params import * +from m5.proxy import * +from VirtIO import VirtIODeviceBase + +class VirtIOConsole(VirtIODeviceBase): + type = 'VirtIOConsole' + cxx_header = 'dev/virtio/console.hh' + + qRecvSize = Param.Unsigned(16, "Receive queue size (descriptors)") + qTransSize = Param.Unsigned(16, "Transmit queue size (descriptors)") + + terminal = Param.Terminal(Parent.any, "The terminal") 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); +} diff --git a/src/dev/virtio/console.hh b/src/dev/virtio/console.hh new file mode 100644 index 000000000..e41ff9a65 --- /dev/null +++ b/src/dev/virtio/console.hh @@ -0,0 +1,155 @@ +/* + * 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 + */ + +#ifndef __DEV_VIRTIO_CONSOLE_HH__ +#define __DEV_VIRTIO_CONSOLE_HH__ + +#include "dev/virtio/base.hh" +#include "dev/terminal.hh" + +struct VirtIOConsoleParams; + +/** + * VirtIO console + * + * The VirtIO console uses the following queues: + * -# Port0 receive (from host to guest) + * -# Port0 transmit (from guest to host) + * -# Control receive (optional) + * -# Control transmit (optional) + * -# Port1 receive (optional) + * -# Port1 transmit (optional) + * + * This implementation implements the minimum of features for one + * port, which means that the multiport feature is not announced and + * only queue 0 and 1 are available. + * + * @see https://github.com/rustyrussell/virtio-spec + * @see http://docs.oasis-open.org/virtio/virtio/v1.0/virtio-v1.0.html + */ +class VirtIOConsole : public VirtIODeviceBase +{ + public: + typedef VirtIOConsoleParams Params; + VirtIOConsole(Params *params); + virtual ~VirtIOConsole(); + + void readConfig(PacketPtr pkt, Addr cfgOffset); + + protected: + /** + * Console configuration structure + * + * @note This needs to be changed if the multiport feature is + * announced! + */ + struct Config { + uint16_t cols; + uint16_t rows; + } M5_ATTR_PACKED; + + /** Currently active configuration (host byte order) */ + Config config; + + /** VirtIO device ID */ + static const DeviceId ID_CONSOLE = 0x03; + + /** @{ + * @name Feature bits + */ + /** Provides the size information */ + static const FeatureBits F_SIZE = 0x01; + /** Supports the multi-port interface */ + static const FeatureBits F_MULTIPORT = 0x02; + /** @} */ + + + protected: + /** + * Virtqueue for data going from the host to the guest. + */ + class TermRecvQueue + : public VirtQueue + { + public: + TermRecvQueue(PortProxy &proxy, uint16_t size, VirtIOConsole &_parent) + : VirtQueue(proxy, size), parent(_parent) {} + virtual ~TermRecvQueue() {} + + void onNotify() { trySend(); } + + /** Try to send data pending data from the terminal. */ + void trySend(); + + std::string name() const { return parent.name() + ".qRecv"; } + + protected: + VirtIOConsole &parent; + }; + /** Receive queue for port 0 */ + TermRecvQueue qRecv; + + /** + * Virtqueue for data going from the guest to the host. + */ + class TermTransQueue + : public VirtQueue + { + public: + TermTransQueue(PortProxy &proxy, uint16_t size, VirtIOConsole &_parent) + : VirtQueue(proxy, size), parent(_parent) {} + virtual ~TermTransQueue() {} + + void onNotifyDescriptor(VirtDescriptor *desc); + + std::string name() const { return parent.name() + ".qTrans"; } + + protected: + VirtIOConsole &parent; + }; + /** Transmit queue for port 0 */ + TermTransQueue qTrans; + + protected: + Terminal &term; + MakeCallback callbackDataAvail; +}; + +#endif // __DEV_VIRTIO_CONSOLE_HH__