85 lines
2.7 KiB
C++
85 lines
2.7 KiB
C++
#ifndef __VALUECAN4INDUSTRIAL_ETH_H_
|
|
#define __VALUECAN4INDUSTRIAL_ETH_H_
|
|
|
|
#ifdef __cplusplus
|
|
|
|
#include "icsneo/device/tree/valuecan4/valuecan4industrial.h"
|
|
#include "icsneo/platform/pcap.h"
|
|
#include <string>
|
|
|
|
namespace icsneo {
|
|
|
|
class ValueCAN4IndustrialETH : public ValueCAN4Industrial {
|
|
public:
|
|
static constexpr const uint16_t ETH_PRODUCT_ID = 0x0012;
|
|
|
|
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<ValueCAN4IndustrialETH>(new ValueCAN4IndustrialETH({}));
|
|
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->type != Message::Type::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 ValueCAN 4 Industrial
|
|
|
|
auto device = foundDev.device;
|
|
device.serial[sn->deviceSerial.copy(device.serial, sizeof(device.serial))] = '\0';
|
|
found.push_back(std::shared_ptr<ValueCAN4IndustrialETH>(new ValueCAN4IndustrialETH(std::move(device))));
|
|
break;
|
|
}
|
|
}
|
|
|
|
return found;
|
|
}
|
|
|
|
static const std::vector<Network>& GetSupportedNetworks() {
|
|
static std::vector<Network> supportedNetworks = {
|
|
Network::NetID::HSCAN,
|
|
Network::NetID::HSCAN2,
|
|
|
|
// No Network::NetID::Ethernet, since we're communicating over it instead
|
|
};
|
|
return supportedNetworks;
|
|
}
|
|
|
|
bool currentDriverSupportsDFU() const override { return false; }
|
|
|
|
protected:
|
|
void setupPacketizer(Packetizer& packetizer) override {
|
|
ValueCAN4Industrial::setupPacketizer(packetizer);
|
|
packetizer.align16bit = false;
|
|
}
|
|
|
|
virtual 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
|
|
virtual void setupSupportedTXNetworks(std::vector<Network>& txNetworks) override { setupSupportedRXNetworks(txNetworks); }
|
|
|
|
private:
|
|
ValueCAN4IndustrialETH(neodevice_t neodevice) : ValueCAN4Industrial(neodevice) {
|
|
initialize<PCAP, ValueCAN4IndustrialSettings>();
|
|
}
|
|
};
|
|
|
|
}
|
|
|
|
#endif // __cplusplus
|
|
|
|
#endif |