vcon_stream_impl.h

/*
 * (c) 2010 Alexander Warg <warg@os.inf.tu-dresden.de>
 *     economic rights: Technische Universität Dresden (Germany)
 *
 * This file is part of TUD:OS and distributed under the terms of the
 * GNU General Public License 2.
 * Please see the COPYING-GPL-2 file for details.
 *
 * As a special exception, you may use this file as part of a free software
 * library without restriction.  Specifically, if other files instantiate
 * templates or use macros or inline functions from this file, or you compile
 * this file and link it with other files to produce an executable, this
 * file does not by itself cause the resulting executable to be covered by
 * the GNU General Public License.  This exception does not however
 * invalidate any other reasons why the executable file might be covered by
 * the GNU General Public License.
 */
 
#include <l4/re/env>
#include <l4/sys/factory>
 
#include "vcon_stream.h"
 
#include <termios.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/ttydefaults.h>
 
namespace L4Re { namespace Core {
Vcon_stream::Vcon_stream(L4::Cap<L4::Vcon> s) noexcept
: Be_file_stream(),
  _s(s), _irq(L4Re::virt_cap_alloc->alloc<L4::Semaphore>()), _irq_bound(false)
{
  int res = l4_error(L4Re::Env::env()->factory()->create(_irq));
  (void)res; // handle errors!
}
 
ssize_t
Vcon_stream::readv(const struct iovec *iovec, int iovcnt) noexcept
{
  if (!_irq_bound)
    {
      bool was_bound = __atomic_exchange_n(&_irq_bound, true, __ATOMIC_SEQ_CST);
      if (!was_bound)
        if (l4_error(_s->bind(0, _irq)) < 0)
          return -EIO;
    }
 
  ssize_t bytes = 0;
  for (; iovcnt > 0; --iovcnt, ++iovec)
    {
      if (iovec->iov_len == 0)
  continue;
 
      char *buf = (char *)iovec->iov_base;
      size_t len = iovec->iov_len;
 
      while (1)
  {
    int ret = _s->read(buf, len);
 
    // BS: what is this ??
    if (ret > (int)len)
      ret = len;
 
    if (ret < 0)
      return ret;
    else if (ret == 0)
      {
        if (bytes)
    return bytes;
 
        ret = _s->read(buf, len);
        if (ret < 0)
    return ret;
        else if (ret == 0)
    {
      _irq->down();
      continue;
    }
      }
 
    bytes += ret;
    len   -= ret;
    buf   += ret;
 
    if (len == 0)
      break;
  }
    }
 
  return bytes;
}
 
ssize_t
Vcon_stream::writev(const struct iovec *iovec, int iovcnt) noexcept
{
  l4_msg_regs_t store;
  l4_msg_regs_t *mr = l4_utcb_mr();
 
  Vfs_config::memcpy(&store, mr, sizeof(store));
 
  ssize_t written = 0;
  while (iovcnt)
    {
      size_t sl = iovec->iov_len;
      char const *b = (char const *)iovec->iov_base;
 
      for (; sl > L4_VCON_WRITE_SIZE
           ; sl -= L4_VCON_WRITE_SIZE, b += L4_VCON_WRITE_SIZE)
        _s->send(b, L4_VCON_WRITE_SIZE);
 
      _s->send(b, sl);
 
      written += iovec->iov_len;
 
      ++iovec;
      --iovcnt;
    }
  Vfs_config::memcpy(mr, &store, sizeof(store));
  return written;
}
 
int
Vcon_stream::fstat64(struct stat64 *buf) const noexcept
{
  buf->st_size = 0;
  buf->st_mode = 0666;
  buf->st_dev = _s.cap();
  buf->st_ino = 0;
  return 0;
}
 
int
Vcon_stream::ioctl(unsigned long request, va_list args) noexcept
{
  switch (request) {
    case TCGETS:
  {
    //vt100_tcgetattr(term, (struct termios *)argp);
 
    struct termios *t = va_arg(args, struct termios *);
 
    l4_vcon_attr_t l4a;
    if (!l4_error(_s->get_attr(&l4a)))
            {
              t->c_iflag = l4a.i_flags;
              t->c_oflag = l4a.o_flags; // output flags
              t->c_cflag = 0; // control flags
              t->c_lflag = l4a.l_flags; // local flags
            }
          else
            t->c_iflag = t->c_oflag = t->c_cflag = t->c_lflag = 0;
#if 0
    //t->c_lflag |= ECHO; // if term->echo
    t->c_lflag |= ICANON; // if term->term_mode == VT100MODE_COOKED
#endif
 
    t->c_cc[VEOF]   = CEOF;
    t->c_cc[VEOL]   = _POSIX_VDISABLE;
    t->c_cc[VEOL2]  = _POSIX_VDISABLE;
    t->c_cc[VERASE] = CERASE;
    t->c_cc[VWERASE]= CWERASE;
    t->c_cc[VKILL]  = CKILL;
    t->c_cc[VREPRINT]=CREPRINT;
    t->c_cc[VINTR]  = CINTR;
    t->c_cc[VQUIT]  = _POSIX_VDISABLE;
    t->c_cc[VSUSP]  = CSUSP;
    t->c_cc[VSTART] = CSTART;
    t->c_cc[VSTOP] = CSTOP;
    t->c_cc[VLNEXT] = CLNEXT;
    t->c_cc[VDISCARD]=CDISCARD;
    t->c_cc[VMIN] = CMIN;
    t->c_cc[VTIME] = 0;
 
  }
 
      return 0;
 
    case TCSETS:
    case TCSETSW:
    case TCSETSF:
  {
    //vt100_tcsetattr(term, (struct termios *)argp);
    struct termios const *t = va_arg(args, struct termios const *);
 
    // XXX: well, we're cheating, get this from the other side!
 
    l4_vcon_attr_t l4a;
    l4a.i_flags = t->c_iflag;
    l4a.o_flags = t->c_oflag; // output flags
    l4a.l_flags = t->c_lflag; // local flags
    _s->set_attr(&l4a);
  }
      return 0;
 
    default:
      break;
  };
  return -EINVAL;
}
 
}}