mirror of
https://github.com/intrepidcs/libicsneo.git
synced 2026-08-05 01:18:36 +02:00
Device: Add T1S extended settings
This commit is contained in:
Thomas Stoddard
committed by
Kyle Schwarz
Kyle Schwarz
parent
6f2ad54adc
commit
146ddaf23c
@@ -0,0 +1,5 @@
|
||||
add_executable(libicsneocpp-t1s-settings src/T1SSettingsExample.cpp)
|
||||
target_link_libraries(libicsneocpp-t1s-settings icsneocpp)
|
||||
|
||||
add_executable(libicsneocpp-t1s-symbol-decoding src/T1SSymbolDecodingExample.cpp)
|
||||
target_link_libraries(libicsneocpp-t1s-symbol-decoding icsneocpp)
|
||||
@@ -0,0 +1,326 @@
|
||||
#include <iostream>
|
||||
#include <iomanip>
|
||||
#include <vector>
|
||||
#include <optional>
|
||||
#include <string>
|
||||
#include <limits>
|
||||
#include <sstream>
|
||||
#include <algorithm>
|
||||
|
||||
#include "icsneo/icsneocpp.h"
|
||||
|
||||
template<typename T>
|
||||
std::string optToString(const std::optional<T>& opt) {
|
||||
if (!opt.has_value())
|
||||
return "N/A";
|
||||
if constexpr (std::is_same_v<T, bool>)
|
||||
return opt.value() ? "true" : "false";
|
||||
else
|
||||
return std::to_string(opt.value());
|
||||
}
|
||||
|
||||
bool getUserConfirmation(const std::string& prompt) {
|
||||
std::string input;
|
||||
std::cout << prompt << " (y/n): " << std::flush;
|
||||
std::getline(std::cin, input);
|
||||
if (!input.empty()) {
|
||||
char c = std::tolower(input[0]);
|
||||
return (c == 'y');
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
std::vector<icsneo::Network::NetID> selectNetworks(const std::vector<icsneo::Network::NetID>& availableNetworks) {
|
||||
std::vector<icsneo::Network::NetID> selectedNetworks;
|
||||
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
std::cout << "Select T1S Networks to Configure" << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
for (size_t i = 0; i < availableNetworks.size(); i++) {
|
||||
std::cout << " [" << (i + 1) << "] " << icsneo::Network(availableNetworks[i]) << std::endl;
|
||||
}
|
||||
|
||||
std::cout << "\nEnter network numbers to configure (e.g., '1,3' or '1-3' or 'all'): " << std::flush;
|
||||
std::string input;
|
||||
std::getline(std::cin, input);
|
||||
|
||||
if (input.empty())
|
||||
return selectedNetworks;
|
||||
|
||||
std::transform(input.begin(), input.end(), input.begin(), ::tolower);
|
||||
|
||||
if (input == "all") {
|
||||
return availableNetworks;
|
||||
}
|
||||
|
||||
std::stringstream ss(input);
|
||||
std::string token;
|
||||
while (std::getline(ss, token, ',')) {
|
||||
token.erase(0, token.find_first_not_of(" \t"));
|
||||
token.erase(token.find_last_not_of(" \t") + 1);
|
||||
|
||||
size_t dashPos = token.find('-');
|
||||
if (dashPos != std::string::npos) {
|
||||
try {
|
||||
int start = std::stoi(token.substr(0, dashPos));
|
||||
int end = std::stoi(token.substr(dashPos + 1));
|
||||
for (int i = start; i <= end; i++) {
|
||||
if (i >= 1 && i <= (int)availableNetworks.size()) {
|
||||
selectedNetworks.push_back(availableNetworks[i - 1]);
|
||||
}
|
||||
}
|
||||
} catch (...) {}
|
||||
} else {
|
||||
try {
|
||||
int num = std::stoi(token);
|
||||
if (num >= 1 && num <= (int)availableNetworks.size()) {
|
||||
selectedNetworks.push_back(availableNetworks[num - 1]);
|
||||
}
|
||||
} catch (...) {}
|
||||
}
|
||||
}
|
||||
|
||||
return selectedNetworks;
|
||||
}
|
||||
|
||||
uint8_t getUint8Input(const std::string& prompt, uint8_t defaultValue) {
|
||||
std::string input;
|
||||
std::cout << prompt << " [" << (int)defaultValue << "]: " << std::flush;
|
||||
std::getline(std::cin, input);
|
||||
if (input.empty())
|
||||
return defaultValue;
|
||||
try {
|
||||
int val = std::stoi(input);
|
||||
if (val >= 0 && val <= 255)
|
||||
return static_cast<uint8_t>(val);
|
||||
} catch (...) {}
|
||||
return defaultValue;
|
||||
}
|
||||
|
||||
uint16_t getUint16Input(const std::string& prompt, uint16_t defaultValue) {
|
||||
std::string input;
|
||||
std::cout << prompt << " [" << (int)defaultValue << "]: " << std::flush;
|
||||
std::getline(std::cin, input);
|
||||
if (input.empty())
|
||||
return defaultValue;
|
||||
try {
|
||||
int val = std::stoi(input);
|
||||
if (val >= 0 && val <= 65535)
|
||||
return static_cast<uint16_t>(val);
|
||||
} catch (...) {}
|
||||
return defaultValue;
|
||||
}
|
||||
|
||||
void displayT1SSettings(const std::shared_ptr<icsneo::Device>& device, icsneo::Network::NetID netId) {
|
||||
std::cout << "\t" << icsneo::Network(netId) << " T1S Settings:" << std::endl;
|
||||
|
||||
std::cout << "\t PLCA Enabled: " << optToString(device->settings->isT1SPLCAEnabledFor(netId)) << std::endl;
|
||||
std::cout << "\t Local ID: " << optToString(device->settings->getT1SLocalIDFor(netId)) << std::endl;
|
||||
std::cout << "\t Max Nodes: " << optToString(device->settings->getT1SMaxNodesFor(netId)) << std::endl;
|
||||
std::cout << "\t TX Opp Timer: " << optToString(device->settings->getT1STxOppTimerFor(netId)) << std::endl;
|
||||
std::cout << "\t Max Burst: " << optToString(device->settings->getT1SMaxBurstFor(netId)) << std::endl;
|
||||
std::cout << "\t Burst Timer: " << optToString(device->settings->getT1SBurstTimerFor(netId)) << std::endl;
|
||||
|
||||
auto termEnabled = device->settings->isT1STerminationEnabledFor(netId);
|
||||
if (termEnabled.has_value())
|
||||
std::cout << "\t Termination: " << optToString(termEnabled) << std::endl;
|
||||
|
||||
auto localIdAlt = device->settings->getT1SLocalIDAlternateFor(netId);
|
||||
if (localIdAlt.has_value()) {
|
||||
std::cout << "\t Local ID Alternate: " << optToString(localIdAlt) << std::endl;
|
||||
std::cout << "\t Bus Dec Beacons: " << optToString(device->settings->isT1SBusDecodingBeaconsEnabledFor(netId)) << std::endl;
|
||||
std::cout << "\t Bus Dec All: " << optToString(device->settings->isT1SBusDecodingAllEnabledFor(netId)) << std::endl;
|
||||
|
||||
auto multiIdMask = device->settings->getT1SMultiIDEnableMaskFor(netId);
|
||||
if (multiIdMask.has_value()) {
|
||||
std::cout << "\t Multi-ID Mask: 0x" << std::hex << std::setw(2) << std::setfill('0')
|
||||
<< (int)multiIdMask.value() << std::dec << std::endl;
|
||||
std::cout << "\t Multi-IDs: ";
|
||||
for (uint8_t i = 0; i < 7; i++) {
|
||||
if (i > 0) std::cout << ", ";
|
||||
auto multiId = device->settings->getT1SMultiIDFor(netId, i);
|
||||
std::cout << "[" << (int)i << "]=" << optToString(multiId);
|
||||
}
|
||||
std::cout << std::endl;
|
||||
}
|
||||
}
|
||||
std::cout << std::endl;
|
||||
}
|
||||
|
||||
void configureT1SNetwork(std::shared_ptr<icsneo::Device>& device, icsneo::Network::NetID netId) {
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
std::cout << "Configuring T1S Network: " << icsneo::Network(netId) << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
std::cout << "\n--- Basic PLCA Settings ---" << std::endl;
|
||||
bool plcaEnabled = getUserConfirmation("Enable PLCA");
|
||||
device->settings->setT1SPLCAFor(netId, plcaEnabled);
|
||||
|
||||
uint8_t localId = getUint8Input("Local ID (0-255)", 1);
|
||||
device->settings->setT1SLocalIDFor(netId, localId);
|
||||
|
||||
uint8_t maxNodes = getUint8Input("Max Nodes (0-255)", 8);
|
||||
device->settings->setT1SMaxNodesFor(netId, maxNodes);
|
||||
|
||||
uint8_t txOppTimer = getUint8Input("TX Opportunity Timer (0-255)", 20);
|
||||
device->settings->setT1STxOppTimerFor(netId, txOppTimer);
|
||||
|
||||
uint16_t maxBurst = getUint16Input("Max Burst (0-65535)", 128);
|
||||
device->settings->setT1SMaxBurstFor(netId, maxBurst);
|
||||
|
||||
uint16_t burstTimer = getUint16Input("Burst Timer (0-65535)", 64);
|
||||
device->settings->setT1SBurstTimerFor(netId, burstTimer);
|
||||
|
||||
if (device->settings->isT1STerminationEnabledFor(netId).has_value()) {
|
||||
std::cout << "\n--- Termination Settings ---" << std::endl;
|
||||
bool termEnabled = getUserConfirmation("Enable Termination");
|
||||
device->settings->setT1STerminationFor(netId, termEnabled);
|
||||
}
|
||||
|
||||
if (device->settings->getT1SLocalIDAlternateFor(netId).has_value()) {
|
||||
std::cout << "\n--- Extended Settings ---" << std::endl;
|
||||
uint8_t localIdAlt = getUint8Input("Local ID Alternate (0-255)", 0);
|
||||
device->settings->setT1SLocalIDAlternateFor(netId, localIdAlt);
|
||||
|
||||
bool busDecBeacons = getUserConfirmation("Enable Bus Decoding (Beacons)");
|
||||
device->settings->setT1SBusDecodingBeaconsFor(netId, busDecBeacons);
|
||||
|
||||
bool busDecAll = getUserConfirmation("Enable Bus Decoding (All Symbols)");
|
||||
device->settings->setT1SBusDecodingAllFor(netId, busDecAll);
|
||||
|
||||
if (getUserConfirmation("Configure Multi-ID settings?")) {
|
||||
uint8_t multiIdMask = getUint8Input("Multi-ID Enable Mask (0x00-0xFF, hex)", 0x00);
|
||||
device->settings->setT1SMultiIDEnableMaskFor(netId, multiIdMask);
|
||||
|
||||
std::cout << "Configure Multi-IDs (7 slots):" << std::endl;
|
||||
for (uint8_t i = 0; i < 7; i++) {
|
||||
uint8_t multiId = getUint8Input(" Multi-ID [" + std::to_string(i) + "]", 0);
|
||||
device->settings->setT1SMultiIDFor(netId, i, multiId);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
std::cout << "\n✓ Configuration complete for " << icsneo::Network(netId) << std::endl;
|
||||
}
|
||||
|
||||
int main() {
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
std::cout << "10BASE-T1S SETTINGS CONFIGURATION EXAMPLE" << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
std::cout << "libicsneo " << icsneo::GetVersion() << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
std::cout << "\nFinding devices... " << std::flush;
|
||||
auto devices = icsneo::FindAllDevices();
|
||||
std::cout << "OK, " << devices.size() << " device" << (devices.size() == 1 ? "" : "s") << " found" << std::endl;
|
||||
|
||||
if (devices.empty()) {
|
||||
std::cout << "No devices found!" << std::endl;
|
||||
return 1;
|
||||
}
|
||||
|
||||
for(auto& device : devices)
|
||||
std::cout << " " << device->describe() << std::endl;
|
||||
|
||||
std::shared_ptr<icsneo::Device> selectedDevice;
|
||||
for(auto& device : devices) {
|
||||
if (device->getType() == icsneo::DeviceType::RADComet3) {
|
||||
selectedDevice = device;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!selectedDevice && !devices.empty())
|
||||
selectedDevice = devices[0];
|
||||
|
||||
if (!selectedDevice) {
|
||||
std::cout << "No suitable device found!" << std::endl;
|
||||
return 1;
|
||||
}
|
||||
|
||||
std::cout << "\nSelected device: " << selectedDevice->describe() << std::endl;
|
||||
std::cout << "Serial: " << selectedDevice->getSerial() << std::endl;
|
||||
|
||||
std::cout << "\nOpening device... " << std::flush;
|
||||
if (!selectedDevice->open()) {
|
||||
std::cout << "✗ Failed" << std::endl;
|
||||
std::cout << icsneo::GetLastError() << std::endl;
|
||||
return 1;
|
||||
}
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
std::vector<icsneo::Network::NetID> candidateNetworks = {
|
||||
icsneo::Network::NetID::AE_01, icsneo::Network::NetID::AE_02,
|
||||
icsneo::Network::NetID::AE_03, icsneo::Network::NetID::AE_04,
|
||||
icsneo::Network::NetID::AE_05, icsneo::Network::NetID::AE_06,
|
||||
icsneo::Network::NetID::AE_07, icsneo::Network::NetID::AE_08,
|
||||
icsneo::Network::NetID::AE_09, icsneo::Network::NetID::AE_10
|
||||
};
|
||||
|
||||
std::vector<icsneo::Network::NetID> t1sNetworks;
|
||||
for (auto netId : candidateNetworks) {
|
||||
auto localId = selectedDevice->settings->getT1SLocalIDFor(netId);
|
||||
if (localId.has_value())
|
||||
t1sNetworks.push_back(netId);
|
||||
}
|
||||
|
||||
if (t1sNetworks.empty()) {
|
||||
std::cout << "No T1S networks found on this device" << std::endl;
|
||||
selectedDevice->close();
|
||||
return 1;
|
||||
}
|
||||
|
||||
std::cout << "\nFound " << t1sNetworks.size() << " T1S network"
|
||||
<< (t1sNetworks.size() == 1 ? "" : "s") << ":" << std::endl;
|
||||
for (size_t i = 0; i < t1sNetworks.size(); i++)
|
||||
std::cout << " [" << (i + 1) << "] " << icsneo::Network(t1sNetworks[i]) << std::endl;
|
||||
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "Current T1S Settings:" << std::endl;
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
for (auto netId : t1sNetworks)
|
||||
displayT1SSettings(selectedDevice, netId);
|
||||
|
||||
auto networksToConfig = selectNetworks(t1sNetworks);
|
||||
|
||||
if (networksToConfig.empty()) {
|
||||
std::cout << "\nNo networks selected for configuration." << std::endl;
|
||||
std::cout << "Closing device... " << std::flush;
|
||||
selectedDevice->close();
|
||||
std::cout << "✓" << std::endl;
|
||||
return 0;
|
||||
}
|
||||
|
||||
std::cout << "\nConfiguring " << networksToConfig.size() << " network"
|
||||
<< (networksToConfig.size() == 1 ? "" : "s") << "..." << std::endl;
|
||||
|
||||
for (auto netId : networksToConfig)
|
||||
configureT1SNetwork(selectedDevice, netId);
|
||||
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
bool saveToEEPROM = getUserConfirmation("Save settings to EEPROM (permanent)?");
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
std::cout << "\nApplying settings" << (saveToEEPROM ? " to EEPROM" : " temporarily") << "... " << std::flush;
|
||||
bool success = selectedDevice->settings->apply(!saveToEEPROM);
|
||||
if (!success) {
|
||||
std::cout << "✗ Failed" << std::endl;
|
||||
std::cout << icsneo::GetLastError() << std::endl;
|
||||
selectedDevice->close();
|
||||
return 1;
|
||||
}
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "Updated T1S Settings:" << std::endl;
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
for (auto netId : t1sNetworks)
|
||||
displayT1SSettings(selectedDevice, netId);
|
||||
|
||||
std::cout << "Closing device... " << std::flush;
|
||||
selectedDevice->close();
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -0,0 +1,357 @@
|
||||
// 10BASE-T1S Symbol Decoding Example
|
||||
// Demonstrates T1S bus symbol decoding and analysis
|
||||
|
||||
#include <iostream>
|
||||
#include <iomanip>
|
||||
#include <thread>
|
||||
#include <chrono>
|
||||
#include <map>
|
||||
#include <string>
|
||||
#include <atomic>
|
||||
|
||||
#include "icsneo/icsneocpp.h"
|
||||
|
||||
enum class T1SSymbol : uint8_t {
|
||||
SSD = 0x04,
|
||||
ESDOK = 0x07,
|
||||
BEACON = 0x08,
|
||||
ESD = 0x0D,
|
||||
ESDERR = 0x11,
|
||||
SYNC = 0x18,
|
||||
ESDJAB = 0x19,
|
||||
SILENCE = 0x1F
|
||||
};
|
||||
|
||||
std::string getSymbolName(uint8_t value) {
|
||||
switch(static_cast<T1SSymbol>(value)) {
|
||||
case T1SSymbol::SSD: return "SSD";
|
||||
case T1SSymbol::ESDOK: return "ESDOK";
|
||||
case T1SSymbol::BEACON: return "BEACON";
|
||||
case T1SSymbol::ESD: return "ESD";
|
||||
case T1SSymbol::ESDERR: return "ESDERR";
|
||||
case T1SSymbol::SYNC: return "SYNC";
|
||||
case T1SSymbol::ESDJAB: return "ESDJAB";
|
||||
case T1SSymbol::SILENCE: return "SILENCE";
|
||||
default:
|
||||
if (value <= 0x0F) {
|
||||
std::stringstream ss;
|
||||
ss << "DATA(0x" << std::hex << std::uppercase << (int)value << ")";
|
||||
return ss.str();
|
||||
}
|
||||
std::stringstream ss;
|
||||
ss << "UNKNOWN(0x" << std::hex << std::uppercase << std::setw(2)
|
||||
<< std::setfill('0') << (int)value << std::setfill(' ') << ")";
|
||||
return ss.str();
|
||||
}
|
||||
}
|
||||
|
||||
struct T1SStatistics {
|
||||
std::atomic<uint64_t> symbolCount{0};
|
||||
std::atomic<uint64_t> beaconCount{0};
|
||||
std::atomic<uint64_t> wakeCount{0};
|
||||
std::atomic<uint64_t> burstCount{0};
|
||||
std::atomic<uint64_t> dataFrameCount{0};
|
||||
std::map<std::string, uint64_t> symbolStats;
|
||||
|
||||
void reset() {
|
||||
symbolCount = 0;
|
||||
beaconCount = 0;
|
||||
wakeCount = 0;
|
||||
burstCount = 0;
|
||||
dataFrameCount = 0;
|
||||
symbolStats.clear();
|
||||
}
|
||||
|
||||
void print() const {
|
||||
std::cout << std::setfill(' ');
|
||||
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
std::cout << "T1S SYMBOL DECODING STATISTICS" << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
std::cout << "Total Symbols: " << symbolCount << std::endl;
|
||||
std::cout << "Total Beacons: " << beaconCount << std::endl;
|
||||
std::cout << "Total Wake Signals: " << wakeCount << std::endl;
|
||||
std::cout << "Total Bursts: " << burstCount << std::endl;
|
||||
std::cout << "Total Data Frames: " << dataFrameCount << std::endl;
|
||||
|
||||
if (!symbolStats.empty()) {
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "Symbol Type Breakdown:" << std::endl;
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
std::vector<std::pair<std::string, uint64_t>> sortedStats(
|
||||
symbolStats.begin(), symbolStats.end());
|
||||
std::sort(sortedStats.begin(), sortedStats.end(),
|
||||
[](const auto& a, const auto& b) { return a.second > b.second; });
|
||||
|
||||
for (const auto& [name, count] : sortedStats) {
|
||||
std::cout << " " << std::left << std::setw(20) << name
|
||||
<< std::right << std::setw(10) << count << std::endl;
|
||||
}
|
||||
}
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
}
|
||||
};
|
||||
|
||||
bool getUserConfirmation(const std::string& prompt) {
|
||||
std::string input;
|
||||
std::cout << prompt << " (y/n): " << std::flush;
|
||||
std::getline(std::cin, input);
|
||||
if (!input.empty()) {
|
||||
char c = std::tolower(input[0]);
|
||||
return (c == 'y');
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
bool configureT1SDecoding(std::shared_ptr<icsneo::Device>& device, icsneo::Network::NetID network,
|
||||
bool enableSymbols, bool enableBeacons) {
|
||||
std::cout << "\nConfiguring T1S decoding on network " << icsneo::Network(network) << "..." << std::endl;
|
||||
if (!device->settings->setT1SBusDecodingAllFor(network, enableSymbols)) {
|
||||
std::cerr << " ✗ Failed to set T1S symbol decoding" << std::endl;
|
||||
return false;
|
||||
}
|
||||
if (enableSymbols) {
|
||||
std::cout << " ✓ Enabled decoding of all T1S symbols" << std::endl;
|
||||
} else {
|
||||
std::cout << " • T1S symbol decoding disabled" << std::endl;
|
||||
}
|
||||
|
||||
if (!device->settings->setT1SBusDecodingBeaconsFor(network, enableBeacons)) {
|
||||
std::cerr << " ✗ Failed to set T1S beacon decoding" << std::endl;
|
||||
return false;
|
||||
}
|
||||
if (enableBeacons) {
|
||||
std::cout << " ✓ Enabled T1S beacon decoding" << std::endl;
|
||||
} else {
|
||||
std::cout << " • T1S beacon decoding disabled" << std::endl;
|
||||
}
|
||||
|
||||
if (!device->settings->apply(true)) {
|
||||
std::cerr << " ✗ Failed to apply settings to device" << std::endl;
|
||||
std::cerr << " " << icsneo::GetLastError() << std::endl;
|
||||
return false;
|
||||
}
|
||||
std::cout << " ✓ Settings applied successfully" << std::endl;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
void setupSymbolMonitoring(std::shared_ptr<icsneo::Device>& device,
|
||||
icsneo::Network::NetID network,
|
||||
T1SStatistics& stats) {
|
||||
|
||||
auto callback = std::make_shared<icsneo::MessageCallback>(
|
||||
icsneo::MessageFilter(network),
|
||||
[&stats](std::shared_ptr<icsneo::Message> message) {
|
||||
if (message->type != icsneo::Message::Type::Frame)
|
||||
return;
|
||||
|
||||
auto frame = std::static_pointer_cast<icsneo::Frame>(message);
|
||||
auto netType = frame->network.getType();
|
||||
if (netType != icsneo::Network::Type::Ethernet && netType != icsneo::Network::Type::AutomotiveEthernet)
|
||||
return;
|
||||
|
||||
auto ethMsg = std::static_pointer_cast<icsneo::EthernetMessage>(frame);
|
||||
|
||||
if (!ethMsg->isT1S)
|
||||
return;
|
||||
|
||||
double timestamp_ms = ethMsg->timestamp / 1000000.0;
|
||||
|
||||
if (ethMsg->isT1SSymbol) {
|
||||
size_t numSymbols = ethMsg->data.size();
|
||||
|
||||
std::cout << std::fixed << std::setprecision(3)
|
||||
<< "[" << std::setw(12) << timestamp_ms << " ms] "
|
||||
<< "T1S Symbols";
|
||||
|
||||
if (numSymbols > 0) {
|
||||
std::cout << " (" << numSymbols << " symbol" << (numSymbols > 1 ? "s" : "") << ")";
|
||||
}
|
||||
std::cout << " | Node ID: " << (int)ethMsg->t1sNodeId << std::endl;
|
||||
|
||||
for (size_t i = 0; i < numSymbols; i++) {
|
||||
uint8_t symbolValue = ethMsg->data[i];
|
||||
std::string symbolName = getSymbolName(symbolValue);
|
||||
|
||||
stats.symbolCount++;
|
||||
stats.symbolStats[symbolName]++;
|
||||
|
||||
if (symbolValue == static_cast<uint8_t>(T1SSymbol::BEACON)) {
|
||||
stats.beaconCount++;
|
||||
}
|
||||
|
||||
std::cout << " [" << i << "] " << std::left << std::setw(10) << symbolName << std::right
|
||||
<< " = 0x" << std::hex << std::uppercase << std::setw(2)
|
||||
<< std::setfill('0') << (int)symbolValue << std::setfill(' ')
|
||||
<< std::dec << std::endl;
|
||||
}
|
||||
|
||||
if (numSymbols == 0 && ethMsg->t1sSymbolType != 0) {
|
||||
uint8_t symbolValue = ethMsg->t1sSymbolType;
|
||||
std::string symbolName = getSymbolName(symbolValue);
|
||||
|
||||
stats.symbolCount++;
|
||||
stats.symbolStats[symbolName]++;
|
||||
|
||||
if (symbolValue == static_cast<uint8_t>(T1SSymbol::BEACON)) {
|
||||
stats.beaconCount++;
|
||||
}
|
||||
|
||||
std::cout << " " << std::left << std::setw(10) << symbolName << std::right
|
||||
<< " = 0x" << std::hex << std::uppercase << std::setw(2)
|
||||
<< std::setfill('0') << (int)symbolValue << std::setfill(' ')
|
||||
<< std::dec << " (from t1sSymbolType field)" << std::endl;
|
||||
}
|
||||
}
|
||||
else if (ethMsg->isT1SBurst) {
|
||||
stats.burstCount++;
|
||||
std::cout << std::fixed << std::setprecision(3)
|
||||
<< "[" << std::setw(12) << timestamp_ms << " ms] "
|
||||
<< "BURST | "
|
||||
<< "Node ID: " << (int)ethMsg->t1sNodeId << " | "
|
||||
<< "Burst Count: " << (int)ethMsg->t1sBurstCount << std::endl;
|
||||
}
|
||||
else if (ethMsg->isT1SWake) {
|
||||
stats.wakeCount++;
|
||||
std::cout << std::fixed << std::setprecision(3)
|
||||
<< "[" << std::setw(12) << timestamp_ms << " ms] "
|
||||
<< "WAKE signal detected | "
|
||||
<< "Node ID: " << (int)ethMsg->t1sNodeId << std::endl;
|
||||
}
|
||||
else {
|
||||
stats.dataFrameCount++;
|
||||
std::cout << std::fixed << std::setprecision(3)
|
||||
<< "[" << std::setw(12) << timestamp_ms << " ms] "
|
||||
<< "T1S Data Frame | "
|
||||
<< "Length: " << ethMsg->data.size() << " bytes | "
|
||||
<< "Node ID: " << (int)ethMsg->t1sNodeId << std::endl;
|
||||
|
||||
if (!ethMsg->data.empty()) {
|
||||
std::cout << " Data: ";
|
||||
size_t preview_len = std::min(ethMsg->data.size(), size_t(16));
|
||||
for (size_t i = 0; i < preview_len; i++) {
|
||||
std::cout << std::hex << std::uppercase << std::setw(2)
|
||||
<< std::setfill('0') << (int)ethMsg->data[i] << " ";
|
||||
}
|
||||
if (ethMsg->data.size() > 16)
|
||||
std::cout << "...";
|
||||
std::cout << std::setfill(' ') << std::dec << std::endl;
|
||||
}
|
||||
}
|
||||
}
|
||||
);
|
||||
|
||||
device->addMessageCallback(callback);
|
||||
}
|
||||
|
||||
int main() {
|
||||
const icsneo::Network::NetID MONITOR_NETWORK = icsneo::Network::NetID::AE_02;
|
||||
const int MONITOR_DURATION_SECONDS = 30;
|
||||
|
||||
std::cout << "\n" << std::string(70, '=') << std::endl;
|
||||
std::cout << "10BASE-T1S SYMBOL DECODING EXAMPLE" << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
std::cout << "libicsneo " << icsneo::GetVersion() << std::endl;
|
||||
std::cout << std::string(70, '=') << std::endl;
|
||||
|
||||
std::cout << "\nFinding devices... " << std::flush;
|
||||
auto devices = icsneo::FindAllDevices();
|
||||
std::cout << "OK, " << devices.size() << " device" << (devices.size() == 1 ? "" : "s") << " found" << std::endl;
|
||||
|
||||
if (devices.empty()) {
|
||||
std::cerr << "No devices found!" << std::endl;
|
||||
return 1;
|
||||
}
|
||||
|
||||
// List devices
|
||||
for (const auto& device : devices) {
|
||||
std::cout << " " << device->describe() << std::endl;
|
||||
}
|
||||
|
||||
std::shared_ptr<icsneo::Device> device;
|
||||
for (auto& dev : devices) {
|
||||
if (dev->getType() == icsneo::DeviceType::RADComet3) {
|
||||
device = dev;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!device && !devices.empty())
|
||||
device = devices[0];
|
||||
|
||||
if (!device) {
|
||||
std::cerr << "No suitable device found!" << std::endl;
|
||||
return 1;
|
||||
}
|
||||
|
||||
std::cout << "\nSelected device: " << device->describe() << std::endl;
|
||||
std::cout << "Serial: " << device->getSerial() << std::endl;
|
||||
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "T1S DECODING CONFIGURATION" << std::endl;
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
bool enableSymbols = getUserConfirmation("Enable T1S symbol decoding (all symbols)");
|
||||
bool enableBeacons = getUserConfirmation("Enable T1S beacon decoding");
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
|
||||
std::cout << "\nOpening device... " << std::flush;
|
||||
if (!device->open()) {
|
||||
std::cerr << "✗ Failed" << std::endl;
|
||||
std::cerr << " " << icsneo::GetLastError() << std::endl;
|
||||
return 1;
|
||||
}
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
std::cout << "Enabling message polling... " << std::flush;
|
||||
if (!device->enableMessagePolling()) {
|
||||
std::cerr << "✗ Failed" << std::endl;
|
||||
std::cerr << " " << icsneo::GetLastError() << std::endl;
|
||||
device->close();
|
||||
return 1;
|
||||
}
|
||||
device->setPollingMessageLimit(100000);
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
if (!configureT1SDecoding(device, MONITOR_NETWORK, enableSymbols, enableBeacons)) {
|
||||
device->close();
|
||||
return 1;
|
||||
}
|
||||
|
||||
std::cout << "Going online... " << std::flush;
|
||||
if (!device->goOnline()) {
|
||||
std::cerr << "✗ Failed" << std::endl;
|
||||
std::cerr << " " << icsneo::GetLastError() << std::endl;
|
||||
device->close();
|
||||
return 1;
|
||||
}
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
T1SStatistics stats;
|
||||
setupSymbolMonitoring(device, MONITOR_NETWORK, stats);
|
||||
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "Monitoring T1S traffic for " << MONITOR_DURATION_SECONDS << " seconds..." << std::endl;
|
||||
std::cout << std::string(70, '-') << std::endl;
|
||||
|
||||
auto startTime = std::chrono::steady_clock::now();
|
||||
std::vector<std::shared_ptr<icsneo::Message>> messages;
|
||||
messages.reserve(10000);
|
||||
|
||||
while (std::chrono::steady_clock::now() - startTime < std::chrono::seconds(MONITOR_DURATION_SECONDS)) {
|
||||
device->getMessages(messages);
|
||||
messages.clear();
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(10));
|
||||
}
|
||||
|
||||
std::cout << "\n" << std::string(70, '-') << std::endl;
|
||||
std::cout << "Closing device... " << std::flush;
|
||||
device->close();
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(100));
|
||||
std::cout << "✓" << std::endl;
|
||||
|
||||
stats.print();
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user