Subversion Repositories w11

// $Id: Rw11CntlDL11.cpp 516 2013-05-05 21:24:52Z mueller $
//
// Copyright 2013- by Walter F.J. Mueller <W.F.J.Mueller@gsi.de>
//
// This program is free software; you may redistribute and/or modify it under
// the terms of the GNU General Public License as published by the Free
// Software Foundation, either version 2, or at your option any later version.
//
// This program is distributed in the hope that it will be useful, but
// WITHOUT ANY WARRANTY, without even the implied warranty of MERCHANTABILITY
// or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
// for complete details.
// 
// Revision History: 
// Date         Rev Version  Comment
// 2013-05-04   516   1.0.2  add RxRlim support (receive interrupt rate limit)
// 2013-04-20   508   1.0.1  add trace support
// 2013-03-06   495   1.0    Initial version
// 2013-02-05   483   0.1    First draft
// ---------------------------------------------------------------------------
 
/*!
  \file
  \version $Id: Rw11CntlDL11.cpp 516 2013-05-05 21:24:52Z mueller $
  \brief   Implemenation of Rw11CntlDL11.
*/
 
#include "boost/bind.hpp"
 
#include "librtools/RosFill.hpp"
#include "librtools/RosPrintBvi.hpp"
#include "librtools/RosPrintf.hpp"
#include "librtools/Rexception.hpp"
#include "librtools/RlogMsg.hpp"
 
#include "Rw11CntlDL11.hpp"
 
using namespace std;
 
/*!
  \class Retro::Rw11CntlDL11
  \brief FIXME_docs
*/
 
// all method definitions in namespace Retro
namespace Retro {
 
//------------------------------------------+-----------------------------------
// constants definitions
 
const uint16_t Rw11CntlDL11::kIbaddr;
const int      Rw11CntlDL11::kLam;
 
const uint16_t Rw11CntlDL11::kRCSR; 
const uint16_t Rw11CntlDL11::kRBUF; 
const uint16_t Rw11CntlDL11::kXCSR; 
const uint16_t Rw11CntlDL11::kXBUF; 
 
const uint16_t Rw11CntlDL11::kProbeOff;
const bool     Rw11CntlDL11::kProbeInt;
const bool     Rw11CntlDL11::kProbeRem;
 
const uint16_t Rw11CntlDL11::kRCSR_M_RXRLIM;
const uint16_t Rw11CntlDL11::kRCSR_V_RXRLIM;
const uint16_t Rw11CntlDL11::kRCSR_B_RXRLIM;
const uint16_t Rw11CntlDL11::kRCSR_M_RDONE;
const uint16_t Rw11CntlDL11::kXCSR_M_XRDY;
const uint16_t Rw11CntlDL11::kXBUF_M_RRDY;
const uint16_t Rw11CntlDL11::kXBUF_M_XVAL;
const uint16_t Rw11CntlDL11::kXBUF_M_XBUF;
 
//------------------------------------------+-----------------------------------
//! Default constructor
 
Rw11CntlDL11::Rw11CntlDL11()
  : Rw11CntlBase<Rw11UnitDL11,1>("dl11"),
    fPC_xbuf(0),
    fRxRlim(0)
{
  // must here because Unit have a back-pointer (not available at Rw11CntlBase)
  for (size_t i=0; i<NUnit(); i++) {
    fspUnit[i].reset(new Rw11UnitDL11(this, i));
  }
}
 
//------------------------------------------+-----------------------------------
//! Destructor
 
Rw11CntlDL11::~Rw11CntlDL11()
{}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::Config(const std::string& name, uint16_t base, int lam)
{
  ConfigCntl(name, base, lam, kProbeOff, kProbeInt, kProbeRem);
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::Start()
{
  if (fStarted || fLam<0 || !fEnable || !fProbe.Found())
    throw Rexception("Rw11CntlDL11::Start",
                     "Bad state: started, no lam, not enable, not found");
 
  // setup primary info clist
  fPrimClist.Clear();
  Cpu().AddIbrb(fPrimClist, fBase);
  fPC_xbuf = Cpu().AddRibr(fPrimClist, fBase+kXBUF);
 
  // add attn handler
  Server().AddAttnHandler(boost::bind(&Rw11CntlDL11::AttnHandler, this, _1), 
                          uint16_t(1)<<fLam, (void*)this);
  fStarted = true;
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::UnitSetup(size_t ind)
{
  Rw11Cpu& cpu  = Cpu();
  uint16_t rcsr = (fRxRlim<<kRCSR_V_RXRLIM) & kRCSR_M_RXRLIM;
  RlinkCommandList clist;
  cpu.AddIbrb(clist, fBase);
  cpu.AddWibr(clist, fBase+kRCSR, rcsr);
  Server().Exec(clist);
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::Wakeup()
{
  if (!fspUnit[0]->RcvQueueEmpty()) {
    RlinkCommandList clist;
    Cpu().AddIbrb(clist, fBase);
    size_t ircsr = Cpu().AddRibr(clist, fBase+kRCSR);
    Server().Exec(clist);
    // FIXME_code: handle errors
    uint16_t rcsr = clist[ircsr].Data();
    if ((rcsr & kRCSR_M_RDONE) == 0) {      // RBUF not full
      uint8_t ichr = fspUnit[0]->RcvNext();
      clist.Clear();
      Cpu().AddWibr(clist, fBase+kRBUF, ichr);
      Server().Exec(clist);
      // FIXME_code: handle errors
    }
  }
 
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::SetRxRlim(uint16_t rlim)
{
  if (rlim > kRCSR_B_RXRLIM)
    throw Rexception("Rw11CntlDL11::SetRxRlim","Bad args: rlim too large");
 
  fRxRlim = rlim;
  UnitSetup(0);
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
uint16_t Rw11CntlDL11::RxRlim() const
{
  return fRxRlim;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
void Rw11CntlDL11::Dump(std::ostream& os, int ind, const char* text) const
{
  RosFill bl(ind);
  os << bl << (text?text:"--") << "Rw11CntlDL11 @ " << this << endl;
  os << bl << "  fPC_xbuf:        " << fPC_xbuf << endl;
  os << bl << "  fRxRlim:         " << fRxRlim  << endl;
 
  Rw11CntlBase<Rw11UnitDL11,1>::Dump(os, ind, " ^");
  return;
}
 
//------------------------------------------+-----------------------------------
//! FIXME_docs
 
int Rw11CntlDL11::AttnHandler(const RlinkServer::AttnArgs& args)
{
  RlinkCommandList* pclist;
  size_t off;
 
  GetPrimInfo(args, pclist, off);  
 
  uint16_t xbuf = (*pclist)[off+fPC_xbuf].Data();
 
  uint8_t ochr = xbuf & kXBUF_M_XBUF;
  bool xval = xbuf & kXBUF_M_XVAL;
  bool rrdy = xbuf & kXBUF_M_RRDY;
 
  if (fTraceLevel>0) {
    RlogMsg lmsg(LogFile());
    lmsg << "-I DL11." << Name()
         << " xbuf=" << RosPrintBvi(xbuf,8)
         << " xval=" << xval
         << " rrdy=" << rrdy
         << " rcvq=" << RosPrintf(fspUnit[0]->RcvQueueSize(),"d",3);
    if (xval) {
      lmsg << " char=";
      if (ochr>=040 && ochr<0177) {
        lmsg << "'" << char(ochr) << "'";
      } else {
        lmsg << RosPrintBvi(ochr,8);
        lmsg << " " << ((ochr&0200) ? "|" : " ");
        uint8_t ochr7 = ochr & 0177;
        if (ochr7 < 040) {
          switch (ochr7) {
          case 010: lmsg << "BS"; break;
          case 011: lmsg << "HT"; break;
          case 012: lmsg << "LF"; break;
          case 013: lmsg << "VT"; break;
          case 014: lmsg << "FF"; break;
          case 015: lmsg << "CR"; break;
          default:  lmsg << "^" << char('A'+ochr7);
          }
        } else {
          if (ochr7 < 0177) {
            lmsg << "'" << char(ochr7) << "'";
          } else {
            lmsg << "DEL";
          }
        }
      }
    }
  }
 
  if (xval) {
    fspUnit[0]->Snd(&ochr, 1);
  }
 
  if (rrdy && !fspUnit[0]->RcvQueueEmpty()) {
    uint8_t ichr = fspUnit[0]->RcvNext();
    RlinkCommandList clist;
    Cpu().AddWibr(clist, fBase+kRBUF, ichr);
    Server().Exec(clist);
    // FIXME_code: handle errors
  }
 
  return 0;
}
 
} // end namespace Retro