Subversion Repositories openrisc_2011-10-31

// ----------------------------------------------------------------------------

// RSP packet: implementation

// Copyright (C) 2008  Embecosm Limited <info@embecosm.com>

// Contributor Jeremy Bennett <jeremy.bennett@embecosm.com>

// This file is part of the cycle accurate model of the OpenRISC 1000 based

// system-on-chip, ORPSoC, built using Verilator.

// This program is free software: you can redistribute it and/or modify it

// under the terms of the GNU Lesser General Public License as published by

// the Free Software Foundation, either version 3 of the License, 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 Lesser General Public

// License for more details.

// You should have received a copy of the GNU Lesser General Public License

// along with this program.  If not, see <http://www.gnu.org/licenses/>.

// ----------------------------------------------------------------------------

// $Id: RspPacket.cpp 327 2009-03-07 19:10:56Z jeremy $

#include <iomanip>

#include <iostream>

#include <cstring>

#include <cerrno>

#include <cstdio>

#include "RspPacket.h"

#include "Utils.h"

using std::ostream;

using std::cerr;

using std::dec;

using std::endl;

using std::hex;

using std::setfill;

using std::setw;

//-----------------------------------------------------------------------------

//! Constructor

//! Allocate the new data buffer

//! @param[in]  _rspConnection  The RSP connection we will use

//! @param[in]  _bufSize        Size of data buffer to allocate

//-----------------------------------------------------------------------------

RspPacket::RspPacket(int _bufSize):

bufSize(_bufSize)

{

        data = new char[_bufSize];

}                               // RspPacket ();

//-----------------------------------------------------------------------------

//! Destructor

//! Give back the data buffer

//-----------------------------------------------------------------------------

RspPacket::~RspPacket()

{

        delete[]data;

}                               // ~RspPacket ()

//-----------------------------------------------------------------------------

//! Pack a string into a packet.

//! A convenience version of this method.

//! @param  str  The string to copy into the data packet before sending

//-----------------------------------------------------------------------------

void

 RspPacket::packStr(const char *str)

{

        int slen = strlen(str);

        // Construct the packet to send, so long as string is not too big, otherwise

        // truncate. Add EOS at the end for convenient debug printout

        if (slen >= bufSize) {

                cerr << "Warning: String \"" << str

                    << "\" too large for RSP packet: truncated\n" << endl;

                slen = bufSize - 1;

        }

        strncpy(data, str, slen);

        data[slen] = 0;

        len = slen;

}                               // packStr ()

//-----------------------------------------------------------------------------

//! Get the data buffer size

//! @return  The data buffer size

//-----------------------------------------------------------------------------

int RspPacket::getBufSize()

{

        return bufSize;

}                               // getBufSize ()

//-----------------------------------------------------------------------------

//! Get the current number of chars in the data buffer

//! @return  The number of chars in the data buffer

//-----------------------------------------------------------------------------

int RspPacket::getLen()

{

        return len;

}                               // getLen ()

//-----------------------------------------------------------------------------

//! Set the number of chars in the data buffer

//! @param[in] _len  The number of chars to be set

//-----------------------------------------------------------------------------

void RspPacket::setLen(int _len)

{

        len = _len;

}                               // setLen ()

//-----------------------------------------------------------------------------

//! Output stream operator

//! @param[out] s  Stream to output to

//! @param[in]  p  Packet to output

//-----------------------------------------------------------------------------

ostream & operator<<(ostream & s, RspPacket & p)

{

        return s << "RSP packet: " << std::dec << std::setw(3) << p.getLen()

            << std::setw(0) << " chars, \"" << p.data << "\"";

}                               // operator<< ()