134 lines
4.0 KiB
C++
134 lines
4.0 KiB
C++
#ifndef __RADGALAXY_H_
|
|
#define __RADGALAXY_H_
|
|
|
|
#ifdef __cplusplus
|
|
|
|
#include "icsneo/device/device.h"
|
|
#include "icsneo/device/devicetype.h"
|
|
#include "icsneo/platform/pcap.h"
|
|
#include "icsneo/communication/packetizer.h"
|
|
#include "icsneo/communication/decoder.h"
|
|
#include "icsneo/device/tree/radgalaxy/radgalaxysettings.h"
|
|
|
|
namespace icsneo {
|
|
|
|
class RADGalaxy : public Device {
|
|
public:
|
|
// Serial numbers start with RG
|
|
static constexpr DeviceType::Enum DEVICE_TYPE = DeviceType::RADGalaxy;
|
|
static constexpr const uint16_t PRODUCT_ID = 0x0003;
|
|
static constexpr const char* SERIAL_START = "RG";
|
|
static std::vector<std::shared_ptr<Device>> Find(const std::vector<PCAP::PCAPFoundDevice>& pcapDevices) {
|
|
std::vector<std::shared_ptr<Device>> found;
|
|
|
|
for(auto& foundDev : pcapDevices) {
|
|
auto fakedev = std::shared_ptr<RADGalaxy>(new RADGalaxy({}));
|
|
for(auto& payload : foundDev.discoveryPackets)
|
|
fakedev->com->packetizer->input(payload);
|
|
for(auto& packet : fakedev->com->packetizer->output()) {
|
|
std::shared_ptr<Message> msg;
|
|
if(!fakedev->com->decoder->decode(msg, packet))
|
|
continue; // We failed to decode this packet
|
|
|
|
if(!msg || msg->network.getNetID() != Network::NetID::Main51)
|
|
continue; // Not a message we care about
|
|
auto sn = std::dynamic_pointer_cast<SerialNumberMessage>(msg);
|
|
if(!sn)
|
|
continue; // Not a serial number message
|
|
|
|
if(sn->deviceSerial.length() < 2)
|
|
continue;
|
|
if(sn->deviceSerial.substr(0, 2) != SERIAL_START)
|
|
continue; // Not a RADGalaxy
|
|
|
|
auto device = foundDev.device;
|
|
device.serial[sn->deviceSerial.copy(device.serial, sizeof(device.serial))] = '\0';
|
|
found.emplace_back(new RADGalaxy(std::move(device)));
|
|
break;
|
|
}
|
|
}
|
|
|
|
return found;
|
|
}
|
|
|
|
static const std::vector<Network>& GetSupportedNetworks() {
|
|
static std::vector<Network> supportedNetworks = {
|
|
Network::NetID::HSCAN,
|
|
Network::NetID::MSCAN,
|
|
Network::NetID::HSCAN2,
|
|
Network::NetID::HSCAN3,
|
|
Network::NetID::HSCAN4,
|
|
Network::NetID::HSCAN5,
|
|
Network::NetID::HSCAN6,
|
|
Network::NetID::HSCAN7,
|
|
|
|
Network::NetID::SWCAN,
|
|
Network::NetID::SWCAN2,
|
|
|
|
Network::NetID::LIN,
|
|
|
|
Network::NetID::Ethernet,
|
|
|
|
Network::NetID::OP_Ethernet1,
|
|
Network::NetID::OP_Ethernet2,
|
|
Network::NetID::OP_Ethernet3,
|
|
Network::NetID::OP_Ethernet4,
|
|
Network::NetID::OP_Ethernet5,
|
|
Network::NetID::OP_Ethernet6,
|
|
Network::NetID::OP_Ethernet7,
|
|
Network::NetID::OP_Ethernet8,
|
|
Network::NetID::OP_Ethernet9,
|
|
Network::NetID::OP_Ethernet10,
|
|
Network::NetID::OP_Ethernet11,
|
|
Network::NetID::OP_Ethernet12
|
|
};
|
|
return supportedNetworks;
|
|
}
|
|
|
|
RADGalaxy(neodevice_t neodevice) : Device(neodevice) {
|
|
initialize<PCAP, RADGalaxySettings>();
|
|
getWritableNeoDevice().type = DEVICE_TYPE;
|
|
productId = PRODUCT_ID;
|
|
}
|
|
|
|
size_t getEthernetActivationLineCount() const override { return 1; }
|
|
|
|
protected:
|
|
void setupPacketizer(Packetizer& packetizer) override {
|
|
Device::setupPacketizer(packetizer);
|
|
packetizer.disableChecksum = true;
|
|
packetizer.align16bit = false;
|
|
}
|
|
|
|
void setupEncoder(Encoder& encoder) override {
|
|
Device::setupEncoder(encoder);
|
|
encoder.supportCANFD = true;
|
|
}
|
|
|
|
void setupDecoder(Decoder& decoder) override {
|
|
Device::setupDecoder(decoder);
|
|
decoder.timestampResolution = 10; // Timestamps are in 10ns increments instead of the usual 25ns
|
|
}
|
|
|
|
void setupSupportedRXNetworks(std::vector<Network>& rxNetworks) override {
|
|
for(auto& netid : GetSupportedNetworks())
|
|
rxNetworks.emplace_back(netid);
|
|
}
|
|
|
|
// The supported TX networks are the same as the supported RX networks for this device
|
|
void setupSupportedTXNetworks(std::vector<Network>& txNetworks) override { setupSupportedRXNetworks(txNetworks); }
|
|
|
|
void handleDeviceStatus(const std::shared_ptr<Message>& message) override {
|
|
if(!message || message->data.size() < sizeof(radgalaxy_status_t))
|
|
return;
|
|
std::lock_guard<std::mutex> lk(ioMutex);
|
|
const radgalaxy_status_t* status = reinterpret_cast<const radgalaxy_status_t*>(message->data.data());
|
|
ethActivationStatus = status->ethernetActivationLineEnabled;
|
|
}
|
|
};
|
|
|
|
}
|
|
|
|
#endif // __cplusplus
|
|
|
|
#endif |