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<< ()