// $Id: RtclRlinkConnect.cpp 576 2014-08-02 12:24:28Z mueller $
|
// $Id: RtclRlinkConnect.cpp 576 2014-08-02 12:24:28Z mueller $
|
//
|
//
|
// Copyright 2011-2014 by Walter F.J. Mueller <W.F.J.Mueller@gsi.de>
|
// Copyright 2011-2014 by Walter F.J. Mueller <W.F.J.Mueller@gsi.de>
|
//
|
//
|
// This program is free software; you may redistribute and/or modify it under
|
// 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
|
// 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.
|
// 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
|
// This program is distributed in the hope that it will be useful, but
|
// WITHOUT ANY WARRANTY, without even the implied warranty of MERCHANTABILITY
|
// WITHOUT ANY WARRANTY, without even the implied warranty of MERCHANTABILITY
|
// or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
// or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
// for complete details.
|
// for complete details.
|
//
|
//
|
// Revision History:
|
// Revision History:
|
// Date Rev Version Comment
|
// Date Rev Version Comment
|
// 2014-08-02 576 1.1.7 bugfix: redo estatdef logic; avoid LastExpect()
|
// 2014-08-02 576 1.1.7 bugfix: redo estatdef logic; avoid LastExpect()
|
// 2013-02-23 492 1.1.6 use RlogFile.Name(); use Context().ErrorCount()
|
// 2013-02-23 492 1.1.6 use RlogFile.Name(); use Context().ErrorCount()
|
// 2013-02-22 491 1.1.5 use new RlogFile/RlogMsg interfaces
|
// 2013-02-22 491 1.1.5 use new RlogFile/RlogMsg interfaces
|
// 2013-02-02 480 1.1.4 allow empty exec commands
|
// 2013-02-02 480 1.1.4 allow empty exec commands
|
// 2013-01-27 478 1.1.3 use RtclRlinkPort::DoRawio on M_rawio
|
// 2013-01-27 478 1.1.3 use RtclRlinkPort::DoRawio on M_rawio
|
// 2013-01-06 473 1.1.2 add M_rawio: rawio -write|-read
|
// 2013-01-06 473 1.1.2 add M_rawio: rawio -write|-read
|
// 2011-11-28 434 1.1.1 ConfigBase(): use uint32_t for lp64 compatibility
|
// 2011-11-28 434 1.1.1 ConfigBase(): use uint32_t for lp64 compatibility
|
// 2011-04-23 380 1.1 use boost/bind instead of RmethDsc
|
// 2011-04-23 380 1.1 use boost/bind instead of RmethDsc
|
// 2011-04-17 376 1.0.1 M_wtlam: now correct log levels
|
// 2011-04-17 376 1.0.1 M_wtlam: now correct log levels
|
// 2011-03-27 374 1.0 Initial version
|
// 2011-03-27 374 1.0 Initial version
|
// 2011-02-11 360 0.1 First draft
|
// 2011-02-11 360 0.1 First draft
|
// ---------------------------------------------------------------------------
|
// ---------------------------------------------------------------------------
|
|
|
/*!
|
/*!
|
\file
|
\file
|
\version $Id: RtclRlinkConnect.cpp 576 2014-08-02 12:24:28Z mueller $
|
\version $Id: RtclRlinkConnect.cpp 576 2014-08-02 12:24:28Z mueller $
|
\brief Implemenation of class RtclRlinkConnect.
|
\brief Implemenation of class RtclRlinkConnect.
|
*/
|
*/
|
|
|
#include <ctype.h>
|
#include <ctype.h>
|
|
|
#include <iostream>
|
#include <iostream>
|
|
|
#include "boost/bind.hpp"
|
#include "boost/bind.hpp"
|
|
|
#include "librtcltools/Rtcl.hpp"
|
#include "librtcltools/Rtcl.hpp"
|
#include "librtcltools/RtclOPtr.hpp"
|
#include "librtcltools/RtclOPtr.hpp"
|
#include "librtcltools/RtclNameSet.hpp"
|
#include "librtcltools/RtclNameSet.hpp"
|
#include "librtcltools/RtclStats.hpp"
|
#include "librtcltools/RtclStats.hpp"
|
#include "librtools/RosPrintf.hpp"
|
#include "librtools/RosPrintf.hpp"
|
#include "librtools/RlogMsg.hpp"
|
#include "librtools/RlogMsg.hpp"
|
#include "librlink/RlinkCommandList.hpp"
|
#include "librlink/RlinkCommandList.hpp"
|
#include "RtclRlinkPort.hpp"
|
#include "RtclRlinkPort.hpp"
|
|
|
#include "RtclRlinkConnect.hpp"
|
#include "RtclRlinkConnect.hpp"
|
|
|
using namespace std;
|
using namespace std;
|
|
|
/*!
|
/*!
|
\class Retro::RtclRlinkConnect
|
\class Retro::RtclRlinkConnect
|
\brief FIXME_docs
|
\brief FIXME_docs
|
*/
|
*/
|
|
|
// all method definitions in namespace Retro
|
// all method definitions in namespace Retro
|
namespace Retro {
|
namespace Retro {
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! Default constructor
|
//! Default constructor
|
|
|
RtclRlinkConnect::RtclRlinkConnect(Tcl_Interp* interp, const char* name)
|
RtclRlinkConnect::RtclRlinkConnect(Tcl_Interp* interp, const char* name)
|
: RtclProxyOwned<RlinkConnect>("RlinkConnect", interp, name,
|
: RtclProxyOwned<RlinkConnect>("RlinkConnect", interp, name,
|
new RlinkConnect())
|
new RlinkConnect())
|
{
|
{
|
AddMeth("open", boost::bind(&RtclRlinkConnect::M_open, this, _1));
|
AddMeth("open", boost::bind(&RtclRlinkConnect::M_open, this, _1));
|
AddMeth("close", boost::bind(&RtclRlinkConnect::M_close, this, _1));
|
AddMeth("close", boost::bind(&RtclRlinkConnect::M_close, this, _1));
|
AddMeth("exec", boost::bind(&RtclRlinkConnect::M_exec, this, _1));
|
AddMeth("exec", boost::bind(&RtclRlinkConnect::M_exec, this, _1));
|
AddMeth("amap", boost::bind(&RtclRlinkConnect::M_amap, this, _1));
|
AddMeth("amap", boost::bind(&RtclRlinkConnect::M_amap, this, _1));
|
AddMeth("errcnt", boost::bind(&RtclRlinkConnect::M_errcnt, this, _1));
|
AddMeth("errcnt", boost::bind(&RtclRlinkConnect::M_errcnt, this, _1));
|
AddMeth("wtlam", boost::bind(&RtclRlinkConnect::M_wtlam, this, _1));
|
AddMeth("wtlam", boost::bind(&RtclRlinkConnect::M_wtlam, this, _1));
|
AddMeth("oob", boost::bind(&RtclRlinkConnect::M_oob, this, _1));
|
AddMeth("oob", boost::bind(&RtclRlinkConnect::M_oob, this, _1));
|
AddMeth("rawio", boost::bind(&RtclRlinkConnect::M_rawio, this, _1));
|
AddMeth("rawio", boost::bind(&RtclRlinkConnect::M_rawio, this, _1));
|
AddMeth("stats", boost::bind(&RtclRlinkConnect::M_stats, this, _1));
|
AddMeth("stats", boost::bind(&RtclRlinkConnect::M_stats, this, _1));
|
AddMeth("log", boost::bind(&RtclRlinkConnect::M_log, this, _1));
|
AddMeth("log", boost::bind(&RtclRlinkConnect::M_log, this, _1));
|
AddMeth("print", boost::bind(&RtclRlinkConnect::M_print, this, _1));
|
AddMeth("print", boost::bind(&RtclRlinkConnect::M_print, this, _1));
|
AddMeth("dump", boost::bind(&RtclRlinkConnect::M_dump, this, _1));
|
AddMeth("dump", boost::bind(&RtclRlinkConnect::M_dump, this, _1));
|
AddMeth("config", boost::bind(&RtclRlinkConnect::M_config, this, _1));
|
AddMeth("config", boost::bind(&RtclRlinkConnect::M_config, this, _1));
|
AddMeth("$default", boost::bind(&RtclRlinkConnect::M_default, this, _1));
|
AddMeth("$default", boost::bind(&RtclRlinkConnect::M_default, this, _1));
|
|
|
for (size_t i=0; i<8; i++) {
|
for (size_t i=0; i<8; i++) {
|
fCmdnameObj[i] = Tcl_NewStringObj(RlinkCommand::CommandName(i), -1);
|
fCmdnameObj[i] = Tcl_NewStringObj(RlinkCommand::CommandName(i), -1);
|
}
|
}
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! Destructor
|
//! Destructor
|
|
|
RtclRlinkConnect::~RtclRlinkConnect()
|
RtclRlinkConnect::~RtclRlinkConnect()
|
{}
|
{}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_open(RtclArgs& args)
|
int RtclRlinkConnect::M_open(RtclArgs& args)
|
{
|
{
|
string path;
|
string path;
|
|
|
if (!args.GetArg("?path", path)) return kERR;
|
if (!args.GetArg("?path", path)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
|
|
RerrMsg emsg;
|
RerrMsg emsg;
|
if (args.NOptMiss() == 0) { // open path
|
if (args.NOptMiss() == 0) { // open path
|
if (!Obj().Open(path, emsg)) return args.Quit(emsg);
|
if (!Obj().Open(path, emsg)) return args.Quit(emsg);
|
} else { // open
|
} else { // open
|
string name = Obj().IsOpen() ? Obj().Port()->Url().Url() : string();
|
string name = Obj().IsOpen() ? Obj().Port()->Url().Url() : string();
|
args.SetResult(name);
|
args.SetResult(name);
|
}
|
}
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_close(RtclArgs& args)
|
int RtclRlinkConnect::M_close(RtclArgs& args)
|
{
|
{
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!Obj().IsOpen()) return args.Quit("-E: port not open");
|
if (!Obj().IsOpen()) return args.Quit("-E: port not open");
|
Obj().Close();
|
Obj().Close();
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_exec(RtclArgs& args)
|
int RtclRlinkConnect::M_exec(RtclArgs& args)
|
{
|
{
|
static RtclNameSet optset("-rreg|-rblk|-wreg|-wblk|-stat|-attn|-init|"
|
static RtclNameSet optset("-rreg|-rblk|-wreg|-wblk|-stat|-attn|-init|"
|
"-edata|-estat|-estatdef|"
|
"-edata|-estat|-estatdef|"
|
"-volatile|-print|-dump|-rlist");
|
"-volatile|-print|-dump|-rlist");
|
|
|
Tcl_Interp* interp = args.Interp();
|
Tcl_Interp* interp = args.Interp();
|
|
|
RlinkCommandList clist;
|
RlinkCommandList clist;
|
string opt;
|
string opt;
|
uint16_t addr;
|
uint16_t addr;
|
|
|
vector<string> vardata;
|
vector<string> vardata;
|
vector<string> varstat;
|
vector<string> varstat;
|
string varprint;
|
string varprint;
|
string vardump;
|
string vardump;
|
string varlist;
|
string varlist;
|
|
|
uint8_t estatdef_val = 0x00;
|
uint8_t estatdef_val = 0x00;
|
uint8_t estatdef_msk = 0xff;
|
uint8_t estatdef_msk = 0xff;
|
|
|
while (args.NextOpt(opt, optset)) {
|
while (args.NextOpt(opt, optset)) {
|
|
|
size_t lsize = clist.Size();
|
size_t lsize = clist.Size();
|
if (opt == "-rreg") { // -rreg addr ?varData ?varStat ---
|
if (opt == "-rreg") { // -rreg addr ?varData ?varStat ---
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddRreg(addr);
|
clist.AddRreg(addr);
|
|
|
} else if (opt == "-rblk") { // -rblk addr size ?varData ?varStat
|
} else if (opt == "-rblk") { // -rblk addr size ?varData ?varStat
|
int32_t bsize;
|
int32_t bsize;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!args.GetArg("bsize", bsize, 1, 256)) return kERR;
|
if (!args.GetArg("bsize", bsize, 1, 256)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddRblk(addr, (size_t) bsize);
|
clist.AddRblk(addr, (size_t) bsize);
|
|
|
} else if (opt == "-wreg") { // -wreg addr data ?varStat -------
|
} else if (opt == "-wreg") { // -wreg addr data ?varStat -------
|
uint16_t data;
|
uint16_t data;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddWreg(addr, data);
|
clist.AddWreg(addr, data);
|
|
|
} else if (opt == "-wblk") { // -wblk addr block ?varStat ------
|
} else if (opt == "-wblk") { // -wblk addr block ?varStat ------
|
vector<uint16_t> block;
|
vector<uint16_t> block;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!args.GetArg("data", block, 1, 256)) return kERR;
|
if (!args.GetArg("data", block, 1, 256)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddWblk(addr, block);
|
clist.AddWblk(addr, block);
|
|
|
} else if (opt == "-stat") { // -stat varData ?varStat ---------
|
} else if (opt == "-stat") { // -stat varData ?varStat ---------
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddStat();
|
clist.AddStat();
|
|
|
} else if (opt == "-attn") { // -attn varData ?varStat ---------
|
} else if (opt == "-attn") { // -attn varData ?varStat ---------
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varData", lsize, vardata)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddAttn();
|
clist.AddAttn();
|
|
|
} else if (opt == "-init") { // -init addr data ?varStat -------
|
} else if (opt == "-init") { // -init addr data ?varStat -------
|
uint16_t data;
|
uint16_t data;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!GetAddr(args, Obj(), addr)) return kERR;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
if (!GetVarName(args, "??varStat", lsize, varstat)) return kERR;
|
clist.AddInit(addr, data);
|
clist.AddInit(addr, data);
|
|
|
} else if (opt == "-edata") { // -edata data ?mask --------------
|
} else if (opt == "-edata") { // -edata data ?mask --------------
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
if (clist[lsize-1].Expect()==0) {
|
if (clist[lsize-1].Expect()==0) {
|
clist[lsize-1].SetExpect(new RlinkCommandExpect(estatdef_val,
|
clist[lsize-1].SetExpect(new RlinkCommandExpect(estatdef_val,
|
estatdef_msk));
|
estatdef_msk));
|
}
|
}
|
if (clist[lsize-1].Command() == RlinkCommand::kCmdRblk) {
|
if (clist[lsize-1].Command() == RlinkCommand::kCmdRblk) {
|
vector<uint16_t> data;
|
vector<uint16_t> data;
|
vector<uint16_t> mask;
|
vector<uint16_t> mask;
|
size_t bsize = clist[lsize-1].BlockSize();
|
size_t bsize = clist[lsize-1].BlockSize();
|
if (!args.GetArg("data", data, 0, bsize)) return kERR;
|
if (!args.GetArg("data", data, 0, bsize)) return kERR;
|
if (!args.GetArg("??mask", mask, 0, bsize)) return kERR;
|
if (!args.GetArg("??mask", mask, 0, bsize)) return kERR;
|
clist[lsize-1].Expect()->SetBlock(data, mask);
|
clist[lsize-1].Expect()->SetBlock(data, mask);
|
} else {
|
} else {
|
uint16_t data=0;
|
uint16_t data=0;
|
uint16_t mask=0;
|
uint16_t mask=0;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!args.GetArg("data", data)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
clist[lsize-1].Expect()->SetData(data, mask);
|
clist[lsize-1].Expect()->SetData(data, mask);
|
}
|
}
|
|
|
} else if (opt == "-estat") { // -estat ?stat ?mask -------------
|
} else if (opt == "-estat") { // -estat ?stat ?mask -------------
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
uint8_t stat=0;
|
uint8_t stat=0;
|
uint8_t mask=0;
|
uint8_t mask=0;
|
if (!args.GetArg("??stat", stat)) return kERR;
|
if (!args.GetArg("??stat", stat)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
if (args.NOptMiss() == 2) mask = 0xff;
|
if (args.NOptMiss() == 2) mask = 0xff;
|
if (clist[lsize-1].Expect()==0) {
|
if (clist[lsize-1].Expect()==0) {
|
clist[lsize-1].SetExpect(new RlinkCommandExpect());
|
clist[lsize-1].SetExpect(new RlinkCommandExpect());
|
}
|
}
|
clist[lsize-1].Expect()->SetStatus(stat, mask);
|
clist[lsize-1].Expect()->SetStatus(stat, mask);
|
|
|
} else if (opt == "-estatdef") { // -estatdef ?stat ?mask -----------
|
} else if (opt == "-estatdef") { // -estatdef ?stat ?mask -----------
|
uint8_t stat=0;
|
uint8_t stat=0;
|
uint8_t mask=0;
|
uint8_t mask=0;
|
if (!args.GetArg("??stat", stat)) return kERR;
|
if (!args.GetArg("??stat", stat)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
if (!args.GetArg("??mask", mask)) return kERR;
|
if (args.NOptMiss() == 2) mask = 0xff;
|
if (args.NOptMiss() == 2) mask = 0xff;
|
estatdef_val = stat;
|
estatdef_val = stat;
|
estatdef_msk = mask;
|
estatdef_msk = mask;
|
|
|
} else if (opt == "-volatile") { // -volatile ----------------------
|
} else if (opt == "-volatile") { // -volatile ----------------------
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
if (!ClistNonEmpty(args, clist)) return kERR;
|
clist.LastVolatile();
|
clist.LastVolatile();
|
|
|
} else if (opt == "-print") { // -print ?varRes -----------------
|
} else if (opt == "-print") { // -print ?varRes -----------------
|
varprint = "-";
|
varprint = "-";
|
if (!args.GetArg("??varRes", varprint)) return kERR;
|
if (!args.GetArg("??varRes", varprint)) return kERR;
|
} else if (opt == "-dump") { // -dump ?varRes ------------------
|
} else if (opt == "-dump") { // -dump ?varRes ------------------
|
vardump = "-";
|
vardump = "-";
|
if (!args.GetArg("??varRes", vardump)) return kERR;
|
if (!args.GetArg("??varRes", vardump)) return kERR;
|
} else if (opt == "-rlist") { // -rlist ?varRes -----------------
|
} else if (opt == "-rlist") { // -rlist ?varRes -----------------
|
varlist = "-";
|
varlist = "-";
|
if (!args.GetArg("??varRes", varlist)) return kERR;
|
if (!args.GetArg("??varRes", varlist)) return kERR;
|
}
|
}
|
|
|
if (estatdef_msk != 0xff && // estatdef defined
|
if (estatdef_msk != 0xff && // estatdef defined
|
lsize != clist.Size()) { // and cmd added to clist
|
lsize != clist.Size()) { // and cmd added to clist
|
for (size_t i=lsize; i<clist.Size(); i++) { // loop over new cmds
|
for (size_t i=lsize; i<clist.Size(); i++) { // loop over new cmds
|
if (clist[i].Expect()==0) { // if no stat
|
if (clist[i].Expect()==0) { // if no stat
|
clist[i].SetExpect(new RlinkCommandExpect(estatdef_val,
|
clist[i].SetExpect(new RlinkCommandExpect(estatdef_val,
|
estatdef_msk));
|
estatdef_msk));
|
}
|
}
|
}
|
}
|
}
|
}
|
|
|
}
|
}
|
|
|
int nact = 0;
|
int nact = 0;
|
if (varprint == "-") nact += 1;
|
if (varprint == "-") nact += 1;
|
if (vardump == "-") nact += 1;
|
if (vardump == "-") nact += 1;
|
if (varlist == "-") nact += 1;
|
if (varlist == "-") nact += 1;
|
if (nact > 1)
|
if (nact > 1)
|
return args.Quit(
|
return args.Quit(
|
"-E: more that one of -print,-dump,-list without target variable found");
|
"-E: more that one of -print,-dump,-list without target variable found");
|
|
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (clist.Size() == 0) return kOK;
|
if (clist.Size() == 0) return kOK;
|
|
|
RerrMsg emsg;
|
RerrMsg emsg;
|
|
|
if (!Obj().Exec(clist, emsg)) return args.Quit(emsg);
|
if (!Obj().Exec(clist, emsg)) return args.Quit(emsg);
|
|
|
for (size_t icmd=0; icmd<clist.Size(); icmd++) {
|
for (size_t icmd=0; icmd<clist.Size(); icmd++) {
|
RlinkCommand& cmd = clist[icmd];
|
RlinkCommand& cmd = clist[icmd];
|
|
|
if (icmd<vardata.size() && !vardata[icmd].empty()) {
|
if (icmd<vardata.size() && !vardata[icmd].empty()) {
|
RtclOPtr pres;
|
RtclOPtr pres;
|
vector<uint16_t> retstat;
|
vector<uint16_t> retstat;
|
RtclOPtr pele;
|
RtclOPtr pele;
|
switch (cmd.Command()) {
|
switch (cmd.Command()) {
|
case RlinkCommand::kCmdRreg:
|
case RlinkCommand::kCmdRreg:
|
case RlinkCommand::kCmdAttn:
|
case RlinkCommand::kCmdAttn:
|
pres = Tcl_NewIntObj((int)cmd.Data());
|
pres = Tcl_NewIntObj((int)cmd.Data());
|
break;
|
break;
|
|
|
case RlinkCommand::kCmdRblk:
|
case RlinkCommand::kCmdRblk:
|
pres = Rtcl::NewListIntObj(cmd.Block());
|
pres = Rtcl::NewListIntObj(cmd.Block());
|
break;
|
break;
|
|
|
case RlinkCommand::kCmdStat:
|
case RlinkCommand::kCmdStat:
|
retstat.resize(2);
|
retstat.resize(2);
|
retstat[0] = cmd.StatRequest();
|
retstat[0] = cmd.StatRequest();
|
retstat[1] = cmd.Data();
|
retstat[1] = cmd.Data();
|
pres = Rtcl::NewListIntObj(retstat);
|
pres = Rtcl::NewListIntObj(retstat);
|
break;
|
break;
|
}
|
}
|
if(!Rtcl::SetVar(interp, vardata[icmd], pres)) return kERR;
|
if(!Rtcl::SetVar(interp, vardata[icmd], pres)) return kERR;
|
}
|
}
|
|
|
if (icmd<varstat.size() && !varstat[icmd].empty()) {
|
if (icmd<varstat.size() && !varstat[icmd].empty()) {
|
RtclOPtr pres(Tcl_NewIntObj((int)cmd.Status()));
|
RtclOPtr pres(Tcl_NewIntObj((int)cmd.Status()));
|
if (!Rtcl::SetVar(interp, varstat[icmd], pres)) return kERR;
|
if (!Rtcl::SetVar(interp, varstat[icmd], pres)) return kERR;
|
}
|
}
|
}
|
}
|
|
|
if (!varprint.empty()) {
|
if (!varprint.empty()) {
|
ostringstream sos;
|
ostringstream sos;
|
const RlinkConnect::LogOpts& logopts = Obj().GetLogOpts();
|
const RlinkConnect::LogOpts& logopts = Obj().GetLogOpts();
|
clist.Print(sos, Obj().Context(), &Obj().AddrMap(), logopts.baseaddr,
|
clist.Print(sos, Obj().Context(), &Obj().AddrMap(), logopts.baseaddr,
|
logopts.basedata, logopts.basestat);
|
logopts.basedata, logopts.basestat);
|
RtclOPtr pobj(Rtcl::NewLinesObj(sos));
|
RtclOPtr pobj(Rtcl::NewLinesObj(sos));
|
if (!Rtcl::SetVarOrResult(args.Interp(), varprint, pobj)) return kERR;
|
if (!Rtcl::SetVarOrResult(args.Interp(), varprint, pobj)) return kERR;
|
}
|
}
|
|
|
if (!vardump.empty()) {
|
if (!vardump.empty()) {
|
ostringstream sos;
|
ostringstream sos;
|
clist.Dump(sos, 0);
|
clist.Dump(sos, 0);
|
RtclOPtr pobj(Rtcl::NewLinesObj(sos));
|
RtclOPtr pobj(Rtcl::NewLinesObj(sos));
|
if (!Rtcl::SetVarOrResult(args.Interp(), vardump, pobj)) return kERR;
|
if (!Rtcl::SetVarOrResult(args.Interp(), vardump, pobj)) return kERR;
|
}
|
}
|
|
|
if (!varlist.empty()) {
|
if (!varlist.empty()) {
|
RtclOPtr prlist(Tcl_NewListObj(0, NULL));
|
RtclOPtr prlist(Tcl_NewListObj(0, NULL));
|
for (size_t icmd=0; icmd<clist.Size(); icmd++) {
|
for (size_t icmd=0; icmd<clist.Size(); icmd++) {
|
RlinkCommand& cmd(clist[icmd]);
|
RlinkCommand& cmd(clist[icmd]);
|
|
|
RtclOPtr pres(Tcl_NewListObj(0, NULL));
|
RtclOPtr pres(Tcl_NewListObj(0, NULL));
|
Tcl_ListObjAppendElement(NULL, pres, fCmdnameObj[cmd.Command()]);
|
Tcl_ListObjAppendElement(NULL, pres, fCmdnameObj[cmd.Command()]);
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Request()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Request()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Flags()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Flags()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Status()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Status()));
|
|
|
switch (cmd.Command()) {
|
switch (cmd.Command()) {
|
case RlinkCommand::kCmdRreg:
|
case RlinkCommand::kCmdRreg:
|
case RlinkCommand::kCmdAttn:
|
case RlinkCommand::kCmdAttn:
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Data()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Data()));
|
break;
|
break;
|
|
|
case RlinkCommand::kCmdRblk:
|
case RlinkCommand::kCmdRblk:
|
Tcl_ListObjAppendElement(NULL, pres,
|
Tcl_ListObjAppendElement(NULL, pres,
|
Rtcl::NewListIntObj(cmd.Block()));
|
Rtcl::NewListIntObj(cmd.Block()));
|
break;
|
break;
|
|
|
case RlinkCommand::kCmdStat:
|
case RlinkCommand::kCmdStat:
|
Tcl_ListObjAppendElement(NULL, pres,
|
Tcl_ListObjAppendElement(NULL, pres,
|
Tcl_NewIntObj((int)cmd.StatRequest()));
|
Tcl_NewIntObj((int)cmd.StatRequest()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Data()));
|
Tcl_ListObjAppendElement(NULL, pres, Tcl_NewIntObj((int)cmd.Data()));
|
break;
|
break;
|
}
|
}
|
Tcl_ListObjAppendElement(NULL, prlist, pres);
|
Tcl_ListObjAppendElement(NULL, prlist, pres);
|
}
|
}
|
if (!Rtcl::SetVarOrResult(args.Interp(), varlist, prlist)) return kERR;
|
if (!Rtcl::SetVarOrResult(args.Interp(), varlist, prlist)) return kERR;
|
}
|
}
|
|
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_amap(RtclArgs& args)
|
int RtclRlinkConnect::M_amap(RtclArgs& args)
|
{
|
{
|
static RtclNameSet optset("-name|-testname|-testaddr|-insert|-erase|"
|
static RtclNameSet optset("-name|-testname|-testaddr|-insert|-erase|"
|
"-clear|-print");
|
"-clear|-print");
|
|
|
const RlinkAddrMap& addrmap = Obj().AddrMap();
|
const RlinkAddrMap& addrmap = Obj().AddrMap();
|
|
|
string opt;
|
string opt;
|
string name;
|
string name;
|
uint16_t addr=0;
|
uint16_t addr=0;
|
|
|
if (args.NextOpt(opt, optset)) {
|
if (args.NextOpt(opt, optset)) {
|
if (opt == "-name") { // amap -name addr
|
if (opt == "-name") { // amap -name addr
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
string tstname;
|
string tstname;
|
if(addrmap.Find(addr, tstname)) {
|
if(addrmap.Find(addr, tstname)) {
|
args.SetResult(tstname);
|
args.SetResult(tstname);
|
} else {
|
} else {
|
return args.Quit(string("-E: address '") + args.PeekArgString(-1) +
|
return args.Quit(string("-E: address '") + args.PeekArgString(-1) +
|
"' not mapped");
|
"' not mapped");
|
}
|
}
|
|
|
} else if (opt == "-testname") { // amap -testname name
|
} else if (opt == "-testname") { // amap -testname name
|
if (!args.GetArg("name", name)) return kERR;
|
if (!args.GetArg("name", name)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
uint16_t tstaddr;
|
uint16_t tstaddr;
|
args.SetResult(int(addrmap.Find(name, tstaddr)));
|
args.SetResult(int(addrmap.Find(name, tstaddr)));
|
|
|
} else if (opt == "-testaddr") { // amap -testaddr addr
|
} else if (opt == "-testaddr") { // amap -testaddr addr
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
string tstname;
|
string tstname;
|
args.SetResult(int(addrmap.Find(addr, tstname)));
|
args.SetResult(int(addrmap.Find(addr, tstname)));
|
|
|
} else if (opt == "-insert") { // amap -insert name addr
|
} else if (opt == "-insert") { // amap -insert name addr
|
uint16_t tstaddr;
|
uint16_t tstaddr;
|
string tstname;
|
string tstname;
|
int tstint;
|
int tstint;
|
if (!args.GetArg("name", name)) return kERR;
|
if (!args.GetArg("name", name)) return kERR;
|
// enforce that the name is not a valid representation of an int
|
// enforce that the name is not a valid representation of an int
|
if (Tcl_GetIntFromObj(NULL, args[args.NDone()-1], &tstint) == kOK)
|
if (Tcl_GetIntFromObj(NULL, args[args.NDone()-1], &tstint) == kOK)
|
return args.Quit(string("-E: name should not look like an int but '")+
|
return args.Quit(string("-E: name should not look like an int but '")+
|
name + "' does");
|
name + "' does");
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.GetArg("addr", addr, 0x00ff)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (addrmap.Find(name, tstaddr))
|
if (addrmap.Find(name, tstaddr))
|
return args.Quit(string("-E: mapping already defined for '")+name+"'");
|
return args.Quit(string("-E: mapping already defined for '")+name+"'");
|
if (addrmap.Find(addr, tstname))
|
if (addrmap.Find(addr, tstname))
|
return args.Quit(string("-E: mapping already defined for address '") +
|
return args.Quit(string("-E: mapping already defined for address '") +
|
args.PeekArgString(-1) + "'");
|
args.PeekArgString(-1) + "'");
|
Obj().AddrMapInsert(name, addr);
|
Obj().AddrMapInsert(name, addr);
|
|
|
} else if (opt == "-erase") { // amap -erase name
|
} else if (opt == "-erase") { // amap -erase name
|
if (!args.GetArg("name", name)) return kERR;
|
if (!args.GetArg("name", name)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!Obj().AddrMapErase(name))
|
if (!Obj().AddrMapErase(name))
|
return args.Quit(string("-E: no mapping defined for '") + name + "'");
|
return args.Quit(string("-E: no mapping defined for '") + name + "'");
|
|
|
} else if (opt == "-clear") { // amap -clear
|
} else if (opt == "-clear") { // amap -clear
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
Obj().AddrMapClear();
|
Obj().AddrMapClear();
|
|
|
} else if (opt == "-print") { // amap -print
|
} else if (opt == "-print") { // amap -print
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
ostringstream sos;
|
ostringstream sos;
|
addrmap.Print(sos);
|
addrmap.Print(sos);
|
args.AppendResultLines(sos);
|
args.AppendResultLines(sos);
|
}
|
}
|
|
|
} else {
|
} else {
|
if (!args.OptValid()) return kERR;
|
if (!args.OptValid()) return kERR;
|
if (!args.GetArg("?name", name)) return kERR;
|
if (!args.GetArg("?name", name)) return kERR;
|
if (args.NOptMiss()==0) { // amap name
|
if (args.NOptMiss()==0) { // amap name
|
uint16_t tstaddr;
|
uint16_t tstaddr;
|
if(addrmap.Find(name, tstaddr)) {
|
if(addrmap.Find(name, tstaddr)) {
|
args.SetResult(int(tstaddr));
|
args.SetResult(int(tstaddr));
|
} else {
|
} else {
|
return args.Quit(string("-E: no mapping defined for '") + name + "'");
|
return args.Quit(string("-E: no mapping defined for '") + name + "'");
|
}
|
}
|
|
|
} else { // amap
|
} else { // amap
|
RtclOPtr plist(Tcl_NewListObj(0, NULL));
|
RtclOPtr plist(Tcl_NewListObj(0, NULL));
|
const RlinkAddrMap::amap_t amap = addrmap.Amap();
|
const RlinkAddrMap::amap_t amap = addrmap.Amap();
|
for (RlinkAddrMap::amap_cit_t it=amap.begin(); it!=amap.end(); it++) {
|
for (RlinkAddrMap::amap_cit_t it=amap.begin(); it!=amap.end(); it++) {
|
Tcl_Obj* tpair[2];
|
Tcl_Obj* tpair[2];
|
tpair[0] = Tcl_NewIntObj(it->first);
|
tpair[0] = Tcl_NewIntObj(it->first);
|
tpair[1] = Tcl_NewStringObj((it->second).c_str(),(it->second).length());
|
tpair[1] = Tcl_NewStringObj((it->second).c_str(),(it->second).length());
|
Tcl_ListObjAppendElement(NULL, plist, Tcl_NewListObj(2, tpair));
|
Tcl_ListObjAppendElement(NULL, plist, Tcl_NewListObj(2, tpair));
|
}
|
}
|
args.SetResult(plist);
|
args.SetResult(plist);
|
}
|
}
|
}
|
}
|
|
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_errcnt(RtclArgs& args)
|
int RtclRlinkConnect::M_errcnt(RtclArgs& args)
|
{
|
{
|
static RtclNameSet optset("-clear");
|
static RtclNameSet optset("-clear");
|
string opt;
|
string opt;
|
bool fclear = false;
|
bool fclear = false;
|
|
|
while (args.NextOpt(opt, optset)) {
|
while (args.NextOpt(opt, optset)) {
|
if (opt == "-clear") fclear = true;
|
if (opt == "-clear") fclear = true;
|
}
|
}
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
|
|
args.SetResult(int(Obj().Context().ErrorCount()));
|
args.SetResult(int(Obj().Context().ErrorCount()));
|
if (fclear) Obj().Context().ClearErrorCount();
|
if (fclear) Obj().Context().ClearErrorCount();
|
|
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_wtlam(RtclArgs& args)
|
int RtclRlinkConnect::M_wtlam(RtclArgs& args)
|
{
|
{
|
double tout;
|
double tout;
|
if (!args.GetArg("tout", tout, 0.001)) return kERR;
|
if (!args.GetArg("tout", tout, 0.001)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
|
|
RerrMsg emsg;
|
RerrMsg emsg;
|
double twait = Obj().WaitAttn(tout, emsg);
|
double twait = Obj().WaitAttn(tout, emsg);
|
|
|
if (twait == -2.) {
|
if (twait == -2.) {
|
return args.Quit(emsg);
|
return args.Quit(emsg);
|
} else if (twait == -1.) {
|
} else if (twait == -1.) {
|
if (Obj().GetLogOpts().printlevel >= 1) {
|
if (Obj().GetLogOpts().printlevel >= 1) {
|
RlogMsg lmsg(Obj().LogFile());
|
RlogMsg lmsg(Obj().LogFile());
|
lmsg << "-- wtlam to=" << RosPrintf(tout, "f", 0,3)
|
lmsg << "-- wtlam to=" << RosPrintf(tout, "f", 0,3)
|
<< " FAIL timeout" << endl;
|
<< " FAIL timeout" << endl;
|
Obj().Context().IncErrorCount();
|
Obj().Context().IncErrorCount();
|
args.SetResult(tout);
|
args.SetResult(tout);
|
return kOK;
|
return kOK;
|
}
|
}
|
}
|
}
|
|
|
if (Obj().GetLogOpts().printlevel >= 3) {
|
if (Obj().GetLogOpts().printlevel >= 3) {
|
RlogMsg lmsg(Obj().LogFile());
|
RlogMsg lmsg(Obj().LogFile());
|
lmsg << "-- wtlam to=" << RosPrintf(tout, "f", 0,3)
|
lmsg << "-- wtlam to=" << RosPrintf(tout, "f", 0,3)
|
<< " T=" << RosPrintf(twait, "f", 0,3)
|
<< " T=" << RosPrintf(twait, "f", 0,3)
|
<< " OK" << endl;
|
<< " OK" << endl;
|
}
|
}
|
|
|
args.SetResult(twait);
|
args.SetResult(twait);
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_oob(RtclArgs& args)
|
int RtclRlinkConnect::M_oob(RtclArgs& args)
|
{
|
{
|
static RtclNameSet optset("-rlmon|-rbmon|-sbcntl|-sbdata");
|
static RtclNameSet optset("-rlmon|-rbmon|-sbcntl|-sbdata");
|
|
|
string opt;
|
string opt;
|
uint16_t addr;
|
uint16_t addr;
|
uint16_t data;
|
uint16_t data;
|
RerrMsg emsg;
|
RerrMsg emsg;
|
|
|
if (args.NextOpt(opt, optset)) {
|
if (args.NextOpt(opt, optset)) {
|
if (opt == "-rlmon") { // oob -rlmon (0|1)
|
if (opt == "-rlmon") { // oob -rlmon (0|1)
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
addr = 15; // rlmon on bit 15
|
addr = 15; // rlmon on bit 15
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
|
|
} else if (opt == "-rbmon") { // oob -rbmon (0|1)
|
} else if (opt == "-rbmon") { // oob -rbmon (0|1)
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
addr = 14; // rbmon on bit 14
|
addr = 14; // rbmon on bit 14
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
|
|
} else if (opt == "-sbcntl") { // oob -sbcntl bit (0|1)
|
} else if (opt == "-sbcntl") { // oob -sbcntl bit (0|1)
|
if (!args.GetArg("bit", addr, 15)) return kERR;
|
if (!args.GetArg("bit", addr, 15)) return kERR;
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.GetArg("val", data, 1)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
if (!Obj().SndOob(0x00, (addr<<8)+data, emsg)) return args.Quit(emsg);
|
|
|
} else if (opt == "-sbdata") { // oob -sbdata addr val
|
} else if (opt == "-sbdata") { // oob -sbdata addr val
|
if (!args.GetArg("bit", addr, 0x0ff)) return kERR;
|
if (!args.GetArg("bit", addr, 0x0ff)) return kERR;
|
if (!args.GetArg("val", data)) return kERR;
|
if (!args.GetArg("val", data)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!Obj().SndOob(addr, data, emsg)) return args.Quit(emsg);
|
if (!Obj().SndOob(addr, data, emsg)) return args.Quit(emsg);
|
}
|
}
|
} else {
|
} else {
|
return args.Quit(
|
return args.Quit(
|
"-E: missing option, one of -rlmon,-rbmon,-sbcntl,-sbdata");
|
"-E: missing option, one of -rlmon,-rbmon,-sbcntl,-sbdata");
|
}
|
}
|
|
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_rawio(RtclArgs& args)
|
int RtclRlinkConnect::M_rawio(RtclArgs& args)
|
{
|
{
|
size_t errcnt = 0;
|
size_t errcnt = 0;
|
int rc = RtclRlinkPort::DoRawio(args, Obj().Port(), errcnt);
|
int rc = RtclRlinkPort::DoRawio(args, Obj().Port(), errcnt);
|
Obj().Context().IncErrorCount(errcnt);
|
Obj().Context().IncErrorCount(errcnt);
|
return rc;
|
return rc;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_stats(RtclArgs& args)
|
int RtclRlinkConnect::M_stats(RtclArgs& args)
|
{
|
{
|
RtclStats::Context cntx;
|
RtclStats::Context cntx;
|
if (!RtclStats::GetArgs(args, cntx)) return kERR;
|
if (!RtclStats::GetArgs(args, cntx)) return kERR;
|
if (!RtclStats::Collect(args, cntx, Obj().Stats())) return kERR;
|
if (!RtclStats::Collect(args, cntx, Obj().Stats())) return kERR;
|
if (Obj().Port()) {
|
if (Obj().Port()) {
|
if (!RtclStats::Collect(args, cntx, Obj().Port()->Stats())) return kERR;
|
if (!RtclStats::Collect(args, cntx, Obj().Port()->Stats())) return kERR;
|
}
|
}
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_log(RtclArgs& args)
|
int RtclRlinkConnect::M_log(RtclArgs& args)
|
{
|
{
|
string msg;
|
string msg;
|
if (!args.GetArg("msg", msg)) return kERR;
|
if (!args.GetArg("msg", msg)) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
if (Obj().GetLogOpts().printlevel != 0 ||
|
if (Obj().GetLogOpts().printlevel != 0 ||
|
Obj().GetLogOpts().dumplevel != 0 ||
|
Obj().GetLogOpts().dumplevel != 0 ||
|
Obj().GetLogOpts().tracelevel != 0) {
|
Obj().GetLogOpts().tracelevel != 0) {
|
Obj().LogFile().Write(string("# ") + msg);
|
Obj().LogFile().Write(string("# ") + msg);
|
}
|
}
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_print(RtclArgs& args)
|
int RtclRlinkConnect::M_print(RtclArgs& args)
|
{
|
{
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
|
|
ostringstream sos;
|
ostringstream sos;
|
Obj().Print(sos);
|
Obj().Print(sos);
|
args.SetResult(sos);
|
args.SetResult(sos);
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_dump(RtclArgs& args)
|
int RtclRlinkConnect::M_dump(RtclArgs& args)
|
{
|
{
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
|
|
ostringstream sos;
|
ostringstream sos;
|
Obj().Dump(sos, 0);
|
Obj().Dump(sos, 0);
|
args.SetResult(sos);
|
args.SetResult(sos);
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_config(RtclArgs& args)
|
int RtclRlinkConnect::M_config(RtclArgs& args)
|
{
|
{
|
static RtclNameSet optset("-baseaddr|-basedata|-basestat|"
|
static RtclNameSet optset("-baseaddr|-basedata|-basestat|"
|
"-logfile|-logprintlevel|-logdumplevel|"
|
"-logfile|-logprintlevel|-logdumplevel|"
|
"-logtracelevel");
|
"-logtracelevel");
|
|
|
RlinkConnect::LogOpts logopts = Obj().GetLogOpts();
|
RlinkConnect::LogOpts logopts = Obj().GetLogOpts();
|
|
|
if (args.NDone() == (size_t)args.Objc()) {
|
if (args.NDone() == (size_t)args.Objc()) {
|
ostringstream sos;
|
ostringstream sos;
|
sos << "-baseaddr " << RosPrintf(logopts.baseaddr, "d")
|
sos << "-baseaddr " << RosPrintf(logopts.baseaddr, "d")
|
<< " -basedata " << RosPrintf(logopts.basedata, "d")
|
<< " -basedata " << RosPrintf(logopts.basedata, "d")
|
<< " -basestat " << RosPrintf(logopts.basestat, "d")
|
<< " -basestat " << RosPrintf(logopts.basestat, "d")
|
<< " -logfile {" << Obj().LogFile().Name() << "}"
|
<< " -logfile {" << Obj().LogFile().Name() << "}"
|
<< " -logprintlevel " << RosPrintf(logopts.printlevel, "d")
|
<< " -logprintlevel " << RosPrintf(logopts.printlevel, "d")
|
<< " -logdumplevel " << RosPrintf(logopts.dumplevel, "d")
|
<< " -logdumplevel " << RosPrintf(logopts.dumplevel, "d")
|
<< " -logtracelevel " << RosPrintf(logopts.tracelevel, "d");
|
<< " -logtracelevel " << RosPrintf(logopts.tracelevel, "d");
|
args.AppendResult(sos);
|
args.AppendResult(sos);
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
string opt;
|
string opt;
|
while (args.NextOpt(opt, optset)) {
|
while (args.NextOpt(opt, optset)) {
|
if (opt == "-baseaddr") { // -baseaddr ?base -----------------
|
if (opt == "-baseaddr") { // -baseaddr ?base -----------------
|
if (!ConfigBase(args, logopts.baseaddr)) return kERR;
|
if (!ConfigBase(args, logopts.baseaddr)) return kERR;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
|
|
} else if (opt == "-basedata") { // -basedata ?base -----------------
|
} else if (opt == "-basedata") { // -basedata ?base -----------------
|
if (!ConfigBase(args, logopts.basedata)) return kERR;
|
if (!ConfigBase(args, logopts.basedata)) return kERR;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
|
|
} else if (opt == "-basestat") { // -basestat ?base -----------------
|
} else if (opt == "-basestat") { // -basestat ?base -----------------
|
if (!ConfigBase(args, logopts.basestat)) return kERR;
|
if (!ConfigBase(args, logopts.basestat)) return kERR;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
|
|
} else if (opt == "-logfile") { // -logfile ?name ------------------
|
} else if (opt == "-logfile") { // -logfile ?name ------------------
|
string name;
|
string name;
|
if (!args.Config("??name", name)) return false;
|
if (!args.Config("??name", name)) return false;
|
if (args.NOptMiss() == 0) { // new filename ?
|
if (args.NOptMiss() == 0) { // new filename ?
|
if (name == "-" || name == "<cout>") {
|
if (name == "-" || name == "<cout>") {
|
Obj().LogUseStream(&cout, "<cout>");
|
Obj().LogUseStream(&cout, "<cout>");
|
} else {
|
} else {
|
if (!Obj().LogOpen(name)) {
|
if (!Obj().LogOpen(name)) {
|
Obj().LogUseStream(&cout, "<cout>");
|
Obj().LogUseStream(&cout, "<cout>");
|
return args.Quit(string("-E: open failed for '") + name +
|
return args.Quit(string("-E: open failed for '") + name +
|
"', using stdout");
|
"', using stdout");
|
}
|
}
|
}
|
}
|
}
|
}
|
|
|
} else if (opt == "-logprintlevel") { // -logprintlevel ?loglevel --------
|
} else if (opt == "-logprintlevel") { // -logprintlevel ?loglevel --------
|
if (!args.Config("??loglevel", logopts.printlevel, 3)) return false;
|
if (!args.Config("??loglevel", logopts.printlevel, 3)) return false;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
|
|
} else if (opt == "-logdumplevel") { // -logdumplevel ?loglevel ---------
|
} else if (opt == "-logdumplevel") { // -logdumplevel ?loglevel ---------
|
if (!args.Config("??loglevel", logopts.dumplevel, 3)) return false;
|
if (!args.Config("??loglevel", logopts.dumplevel, 3)) return false;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
|
|
} else if (opt == "-logtracelevel") { // -logtracelevel ?loglevel --------
|
} else if (opt == "-logtracelevel") { // -logtracelevel ?loglevel --------
|
if (!args.Config("??loglevel", logopts.tracelevel, 3)) return false;
|
if (!args.Config("??loglevel", logopts.tracelevel, 3)) return false;
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
if (args.NOptMiss() == 0) Obj().SetLogOpts(logopts);
|
}
|
}
|
}
|
}
|
|
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
int RtclRlinkConnect::M_default(RtclArgs& args)
|
int RtclRlinkConnect::M_default(RtclArgs& args)
|
{
|
{
|
if (!args.AllDone()) return kERR;
|
if (!args.AllDone()) return kERR;
|
ostringstream sos;
|
ostringstream sos;
|
const RlinkConnect::LogOpts& logopts = Obj().GetLogOpts();
|
const RlinkConnect::LogOpts& logopts = Obj().GetLogOpts();
|
|
|
sos << "print base: " << "addr " << RosPrintf(logopts.baseaddr, "d", 2)
|
sos << "print base: " << "addr " << RosPrintf(logopts.baseaddr, "d", 2)
|
<< " data " << RosPrintf(logopts.basedata, "d", 2)
|
<< " data " << RosPrintf(logopts.basedata, "d", 2)
|
<< " stat " << RosPrintf(logopts.basestat, "d", 2) << endl;
|
<< " stat " << RosPrintf(logopts.basestat, "d", 2) << endl;
|
sos << "logfile: " << Obj().LogFile().Name()
|
sos << "logfile: " << Obj().LogFile().Name()
|
<< " printlevel " << logopts.printlevel
|
<< " printlevel " << logopts.printlevel
|
<< " dumplevel " << logopts.dumplevel;
|
<< " dumplevel " << logopts.dumplevel;
|
|
|
args.AppendResultLines(sos);
|
args.AppendResultLines(sos);
|
return kOK;
|
return kOK;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
bool RtclRlinkConnect::GetAddr(RtclArgs& args, RlinkConnect& conn,
|
bool RtclRlinkConnect::GetAddr(RtclArgs& args, RlinkConnect& conn,
|
uint16_t& addr)
|
uint16_t& addr)
|
{
|
{
|
Tcl_Obj* pobj=0;
|
Tcl_Obj* pobj=0;
|
if (!args.GetArg("addr", pobj)) return kERR;
|
if (!args.GetArg("addr", pobj)) return kERR;
|
|
|
int tstint;
|
int tstint;
|
// if a number is given..
|
// if a number is given..
|
if (Tcl_GetIntFromObj(NULL, pobj, &tstint) == kOK) {
|
if (Tcl_GetIntFromObj(NULL, pobj, &tstint) == kOK) {
|
if (tstint >= 0 && tstint <= 0x00ff) {
|
if (tstint >= 0 && tstint <= 0x00ff) {
|
addr = (uint16_t)tstint;
|
addr = (uint16_t)tstint;
|
} else {
|
} else {
|
args.AppendResult("-E: value '", Tcl_GetString(pobj),
|
args.AppendResult("-E: value '", Tcl_GetString(pobj),
|
"' for 'addr' out of range 0...0x00ff", NULL);
|
"' for 'addr' out of range 0...0x00ff", NULL);
|
return false;
|
return false;
|
}
|
}
|
// if a name is given
|
// if a name is given
|
} else {
|
} else {
|
string name(Tcl_GetString(pobj));
|
string name(Tcl_GetString(pobj));
|
uint16_t tstaddr;
|
uint16_t tstaddr;
|
if (Obj().AddrMap().Find(name, tstaddr)) {
|
if (Obj().AddrMap().Find(name, tstaddr)) {
|
addr = tstaddr;
|
addr = tstaddr;
|
} else {
|
} else {
|
args.AppendResult("-E: no address mapping known for '",
|
args.AppendResult("-E: no address mapping known for '",
|
Tcl_GetString(pobj), "'", NULL);
|
Tcl_GetString(pobj), "'", NULL);
|
return false;
|
return false;
|
}
|
}
|
}
|
}
|
|
|
return true;
|
return true;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
bool RtclRlinkConnect::GetVarName(RtclArgs& args, const char* argname,
|
bool RtclRlinkConnect::GetVarName(RtclArgs& args, const char* argname,
|
size_t nind,
|
size_t nind,
|
std::vector<std::string>& varname)
|
std::vector<std::string>& varname)
|
{
|
{
|
while (varname.size() < nind+1) varname.push_back(string());
|
while (varname.size() < nind+1) varname.push_back(string());
|
string name;
|
string name;
|
if (!args.GetArg(argname, name)) return false;
|
if (!args.GetArg(argname, name)) return false;
|
if (name.length()) { // if variable defined
|
if (name.length()) { // if variable defined
|
char c = name[0];
|
char c = name[0];
|
if (isdigit(c) || c=='+' || c=='-' ) { // check for mistaken number
|
if (isdigit(c) || c=='+' || c=='-' ) { // check for mistaken number
|
args.AppendResult("-E: invalid variable name '", name.c_str(),
|
args.AppendResult("-E: invalid variable name '", name.c_str(),
|
"': looks like a number", NULL);
|
"': looks like a number", NULL);
|
return false;
|
return false;
|
}
|
}
|
}
|
}
|
|
|
varname[nind] = name;
|
varname[nind] = name;
|
return true;
|
return true;
|
}
|
}
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
bool RtclRlinkConnect::ConfigBase(RtclArgs& args, uint32_t& base)
|
bool RtclRlinkConnect::ConfigBase(RtclArgs& args, uint32_t& base)
|
{
|
{
|
uint32_t tmp = base;
|
uint32_t tmp = base;
|
if (!args.Config("??base", tmp, 16, 2)) return false;
|
if (!args.Config("??base", tmp, 16, 2)) return false;
|
if (tmp != base && tmp != 2 && tmp !=8 && tmp != 16) {
|
if (tmp != base && tmp != 2 && tmp !=8 && tmp != 16) {
|
args.AppendResult("-E: base must be 2, 8, or 16, found '",
|
args.AppendResult("-E: base must be 2, 8, or 16, found '",
|
args.PeekArgString(-1), "'", NULL);
|
args.PeekArgString(-1), "'", NULL);
|
return false;
|
return false;
|
}
|
}
|
base = tmp;
|
base = tmp;
|
return true;
|
return true;
|
}
|
}
|
|
|
|
|
//------------------------------------------+-----------------------------------
|
//------------------------------------------+-----------------------------------
|
//! FIXME_docs
|
//! FIXME_docs
|
|
|
bool RtclRlinkConnect::ClistNonEmpty(RtclArgs& args,
|
bool RtclRlinkConnect::ClistNonEmpty(RtclArgs& args,
|
const RlinkCommandList& clist)
|
const RlinkCommandList& clist)
|
{
|
{
|
if (clist.Size() == 0) {
|
if (clist.Size() == 0) {
|
args.AppendResult("-E: -edata, -estat, or -volatile "
|
args.AppendResult("-E: -edata, -estat, or -volatile "
|
"not allowed on empty command list", NULL);
|
"not allowed on empty command list", NULL);
|
return false;
|
return false;
|
}
|
}
|
return true;
|
return true;
|
}
|
}
|
|
|
} // end namespace Retro
|
} // end namespace Retro
|
|
|