mirror of
https://gitlab.com/etherlab.org/ethercat.git
synced 2026-02-06 20:01:44 +08:00
83 lines
2.2 KiB
C++
83 lines
2.2 KiB
C++
/*****************************************************************************
|
|
*
|
|
* $Id$
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include <iostream>
|
|
using namespace std;
|
|
|
|
#include "CommandStates.h"
|
|
|
|
/*****************************************************************************/
|
|
|
|
CommandStates::CommandStates():
|
|
Command("states", "Request application-layer states.")
|
|
{
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
string CommandStates::helpString() const
|
|
{
|
|
stringstream str;
|
|
|
|
str << getName() << " [OPTIONS] <STATE>" << endl
|
|
<< endl
|
|
<< getBriefDescription() << endl
|
|
<< endl
|
|
<< "Arguments:" << endl
|
|
<< " STATE can be 'INIT', 'PREOP', 'SAFEOP', or 'OP'." << endl
|
|
<< endl
|
|
<< "Command-specific options:" << endl
|
|
<< " --slave -s <index> Positive numerical ring position," << endl
|
|
<< " or 'all' for all slaves (default)." << endl
|
|
<< endl
|
|
<< numericInfo();
|
|
|
|
return str.str();
|
|
}
|
|
|
|
/****************************************************************************/
|
|
|
|
void CommandStates::execute(MasterDevice &m, const StringVector &args)
|
|
{
|
|
stringstream err;
|
|
string stateStr;
|
|
uint8_t state = 0x00;
|
|
|
|
if (args.size() != 1) {
|
|
err << "'" << getName() << "' takes exactly one argument!";
|
|
throwInvalidUsageException(err);
|
|
}
|
|
|
|
stateStr = args[0];
|
|
transform(stateStr.begin(), stateStr.end(),
|
|
stateStr.begin(), (int (*) (int)) std::toupper);
|
|
|
|
if (stateStr == "INIT") {
|
|
state = 0x01;
|
|
} else if (stateStr == "PREOP") {
|
|
state = 0x02;
|
|
} else if (stateStr == "SAFEOP") {
|
|
state = 0x04;
|
|
} else if (stateStr == "OP") {
|
|
state = 0x08;
|
|
} else {
|
|
err << "Invalid state '" << args[0] << "'!";
|
|
throwInvalidUsageException(err);
|
|
}
|
|
|
|
m.open(MasterDevice::ReadWrite);
|
|
|
|
if (slavePosition == -1) {
|
|
unsigned int i, numSlaves = m.slaveCount();
|
|
for (i = 0; i < numSlaves; i++)
|
|
m.requestState(i, state);
|
|
} else {
|
|
m.requestState(slavePosition, state);
|
|
}
|
|
}
|
|
|
|
/*****************************************************************************/
|