From c4ec1ee6c6de267a6faefa6bc450b9a05d3a56ec Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Simon=20St=C3=BCrz?= Date: Thu, 9 Dec 2021 22:10:36 +0100 Subject: [PATCH] Finish basic inverter data parsing and implementation --- nymea-plugins.pro | 1 - sma/integrationpluginsma.cpp | 87 +- sma/integrationpluginsma.h | 5 +- sma/integrationpluginsma.json | 26 +- sma/sma.pro | 5 + sma/speedwire.h | 301 +++++++ sma/speedwirediscovery.cpp | 113 ++- sma/speedwirediscovery.h | 41 +- sma/speedwireinterface.cpp | 54 +- sma/speedwireinterface.h | 68 +- sma/speedwireinverter.cpp | 1356 ++++++++++++++++++++++++++---- sma/speedwireinverter.h | 192 ++++- sma/speedwireinverterreply.cpp | 85 ++ sma/speedwireinverterreply.h | 89 ++ sma/speedwireinverterrequest.cpp | 76 ++ sma/speedwireinverterrequest.h | 62 ++ sma/speedwiremeter.cpp | 80 +- sma/speedwiremeter.h | 41 + 18 files changed, 2340 insertions(+), 342 deletions(-) create mode 100644 sma/speedwire.h create mode 100644 sma/speedwireinverterreply.cpp create mode 100644 sma/speedwireinverterreply.h create mode 100644 sma/speedwireinverterrequest.cpp create mode 100644 sma/speedwireinverterrequest.h diff --git a/nymea-plugins.pro b/nymea-plugins.pro index 61d4205a..9265169f 100644 --- a/nymea-plugins.pro +++ b/nymea-plugins.pro @@ -118,7 +118,6 @@ isEmpty(WITH_PLUGINS) { } PLUGINS-=$${WITHOUT_PLUGINS} -# FIXME: PLUGINS=sma message("Building plugins:") for(plugin, PLUGINS) { exists($${plugin}) { diff --git a/sma/integrationpluginsma.cpp b/sma/integrationpluginsma.cpp index a92624c0..a8b7bfe4 100644 --- a/sma/integrationpluginsma.cpp +++ b/sma/integrationpluginsma.cpp @@ -212,12 +212,6 @@ void IntegrationPluginSma::setupThing(ThingSetupInfo *info) connect(sunnyWebBox, &SunnyWebBox::connectedChanged, this, &IntegrationPluginSma::onConnectedChanged); connect(sunnyWebBox, &SunnyWebBox::plantOverviewReceived, this, &IntegrationPluginSma::onPlantOverviewReceived); m_sunnyWebBoxes.insert(info->thing(), sunnyWebBox); - - if (!m_refreshTimer) { - qCDebug(dcSma()) << "Starting refresh timer"; - m_refreshTimer = hardwareManager()->pluginTimerManager()->registerTimer(1); - connect(m_refreshTimer, &PluginTimer::timeout, this, &IntegrationPluginSma::onRefreshTimer); - } }); } else if (thing->thingClassId() == speedwireMeterThingClassId) { QHostAddress address = QHostAddress(thing->paramValue(speedwireMeterThingHostParamTypeId).toString()); @@ -235,7 +229,9 @@ void IntegrationPluginSma::setupThing(ThingSetupInfo *info) return; } - // TODO: reachable state + connect(meter, &SpeedwireMeter::reachableChanged, this, [=](bool reachable){ + thing->setStateValue(speedwireMeterConnectedStateTypeId, reachable); + }); connect(meter, &SpeedwireMeter::valuesUpdated, this, [=](){ thing->setStateValue(speedwireMeterConnectedStateTypeId, true); @@ -278,11 +274,36 @@ void IntegrationPluginSma::setupThing(ThingSetupInfo *info) return; } - // TODO: reachable state + qCDebug(dcSma()) << "Inverter: Interface initialized successfully."; + + connect(inverter, &SpeedwireInverter::reachableChanged, this, [=](bool reachable){ + thing->setStateValue(speedwireInverterConnectedStateTypeId, reachable); + }); + + connect(inverter, &SpeedwireInverter::valuesUpdated, this, [=](){ + thing->setStateValue(speedwireInverterTotalEnergyProducedStateTypeId, inverter->totalEnergyProduced()); + thing->setStateValue(speedwireInverterEnergyProducedTodayStateTypeId, inverter->todayEnergyProduced()); + thing->setStateValue(speedwireInverterCurrentPowerStateTypeId, -inverter->totalAcPower()); + thing->setStateValue(speedwireInverterFrequencyStateTypeId, inverter->gridFrequency()); + + thing->setStateValue(speedwireInverterVoltagePhaseAStateTypeId, inverter->voltageAcPhase1()); + thing->setStateValue(speedwireInverterVoltagePhaseBStateTypeId, inverter->voltageAcPhase2()); + thing->setStateValue(speedwireInverterVoltagePhaseCStateTypeId, inverter->voltageAcPhase3()); + + thing->setStateValue(speedwireInverterCurrentPhaseAStateTypeId, inverter->currentAcPhase1()); + thing->setStateValue(speedwireInverterCurrentPhaseBStateTypeId, inverter->currentAcPhase2()); + thing->setStateValue(speedwireInverterCurrentPhaseCStateTypeId, inverter->currentAcPhase3()); + + thing->setStateValue(speedwireInverterCurrentPowerMpp1StateTypeId, inverter->powerDcMpp1()); + thing->setStateValue(speedwireInverterCurrentPowerMpp2StateTypeId, inverter->powerDcMpp2()); + + }); + m_speedwireInverters.insert(thing, inverter); info->finish(Thing::ThingErrorNoError); - inverter->sendLoginRequest(); + // Initial refresh data + inverter->refresh(); } else { Q_ASSERT_X(false, "setupThing", QString("Unhandled thingClassId: %1").arg(thing->thingClassId().toString()).toUtf8()); } @@ -295,8 +316,19 @@ void IntegrationPluginSma::postSetupThing(Thing *thing) SunnyWebBox *sunnyWebBox = m_sunnyWebBoxes.value(thing); if (!sunnyWebBox) return; + + setupRefreshTimer(); sunnyWebBox->getPlantOverview(); thing->setStateValue(sunnyWebBoxConnectedStateTypeId, true); + } else if (thing->thingClassId() == speedwireInverterThingClassId) { + SpeedwireInverter *inverter = m_speedwireInverters.value(thing); + if (inverter) { + thing->setStateValue(speedwireInverterConnectedStateTypeId, inverter->reachable()); + } else { + thing->setStateValue(speedwireInverterConnectedStateTypeId, false); + } + + setupRefreshTimer(); } } @@ -306,6 +338,14 @@ void IntegrationPluginSma::thingRemoved(Thing *thing) m_sunnyWebBoxes.take(thing)->deleteLater(); } + if (thing->thingClassId() == speedwireMeterThingClassId && m_speedwireMeters.contains(thing)) { + m_speedwireMeters.take(thing)->deleteLater(); + } + + if (thing->thingClassId() == speedwireInverterThingClassId && m_speedwireInverters.contains(thing)) { + m_speedwireInverters.take(thing)->deleteLater(); + } + if (myThings().isEmpty()) { qCDebug(dcSma()) << "Stopping timer"; hardwareManager()->pluginTimerManager()->unregisterTimer(m_refreshTimer); @@ -313,14 +353,6 @@ void IntegrationPluginSma::thingRemoved(Thing *thing) } } -void IntegrationPluginSma::onRefreshTimer() -{ - foreach (Thing *thing, myThings().filterByThingClassId(sunnyWebBoxThingClassId)) { - SunnyWebBox *sunnyWebBox = m_sunnyWebBoxes.value(thing); - sunnyWebBox->getPlantOverview(); - } -} - void IntegrationPluginSma::onConnectedChanged(bool connected) { Thing *thing = m_sunnyWebBoxes.key(static_cast(sender())); @@ -347,3 +379,24 @@ void IntegrationPluginSma::onPlantOverviewReceived(const QString &messageId, Sun thing->setStateValue(sunnyWebBoxErrorStateTypeId, overview.error); } } + +void IntegrationPluginSma::setupRefreshTimer() +{ + // If already set up... + if (m_refreshTimer) + return; + + m_refreshTimer = hardwareManager()->pluginTimerManager()->registerTimer(2); + connect(m_refreshTimer, &PluginTimer::timeout, this, [=](){ + foreach (Thing *thing, myThings().filterByThingClassId(sunnyWebBoxThingClassId)) { + SunnyWebBox *sunnyWebBox = m_sunnyWebBoxes.value(thing); + sunnyWebBox->getPlantOverview(); + } + + foreach (SpeedwireInverter *inverter, m_speedwireInverters) { + inverter->refresh(); + } + }); + + m_refreshTimer->start(); +} diff --git a/sma/integrationpluginsma.h b/sma/integrationpluginsma.h index 169fc1e5..ef3aedc1 100644 --- a/sma/integrationpluginsma.h +++ b/sma/integrationpluginsma.h @@ -53,13 +53,14 @@ public: void thingRemoved(Thing *thing) override; private slots: - void onRefreshTimer(); - void onConnectedChanged(bool connected); void onPlantOverviewReceived(const QString &messageId, SunnyWebBox::Overview overview); + void setupRefreshTimer(); + private: PluginTimer *m_refreshTimer = nullptr; + QHash m_sunnyWebBoxes; QHash m_speedwireMeters; QHash m_speedwireInverters; diff --git a/sma/integrationpluginsma.json b/sma/integrationpluginsma.json index a2a7311f..bdf7c41b 100644 --- a/sma/integrationpluginsma.json +++ b/sma/integrationpluginsma.json @@ -422,8 +422,8 @@ { "id": "b366f680-6134-488b-8362-b1b824a8daca", "name": "currentPowerMpp1", - "displayName": "Current power MPP1", - "displayNameEvent": "Current power MPP1 changed", + "displayName": "DC power MPP1", + "displayNameEvent": "DC power MPP1 changed", "type": "double", "unit": "Watt", "defaultValue": 0 @@ -431,8 +431,8 @@ { "id": "87d9b654-5558-47a3-9db9-ffd7c23b4774", "name": "currentPowerMpp2", - "displayName": "Current power MPP2", - "displayNameEvent": "Current power MPP2 changed", + "displayName": "DC power MPP2", + "displayNameEvent": "DC power MPP2 changed", "type": "double", "unit": "Watt", "defaultValue": 0 @@ -446,6 +446,24 @@ "unit": "KiloWattHour", "defaultValue": 0.00 }, + { + "id": "e8bc8f81-e5c5-4900-b429-93fcaa262fcb", + "name": "energyProducedToday", + "displayName": "Energy produced today", + "displayNameEvent": "Energy produced today changed", + "type": "double", + "unit": "KiloWattHour", + "defaultValue": 0.00 + }, + { + "id": "fdccf5de-7413-4480-9ca0-1151665dede8", + "name": "frequency", + "displayName": "Frequency", + "displayNameEvent": "Frequency changed", + "type": "double", + "unit": "Hertz", + "defaultValue": 0.00 + }, { "id": "6d76cc7b-9e00-4561-be7b-4e2a6b8f7b66", "name": "firmwareVersion", diff --git a/sma/sma.pro b/sma/sma.pro index a64270a2..e663b33a 100644 --- a/sma/sma.pro +++ b/sma/sma.pro @@ -7,13 +7,18 @@ SOURCES += \ speedwirediscovery.cpp \ speedwireinterface.cpp \ speedwireinverter.cpp \ + speedwireinverterreply.cpp \ + speedwireinverterrequest.cpp \ speedwiremeter.cpp \ sunnywebbox.cpp HEADERS += \ integrationpluginsma.h \ + speedwire.h \ speedwirediscovery.h \ speedwireinterface.h \ speedwireinverter.h \ + speedwireinverterreply.h \ + speedwireinverterrequest.h \ speedwiremeter.h \ sunnywebbox.h diff --git a/sma/speedwire.h b/sma/speedwire.h new file mode 100644 index 00000000..3d01a854 --- /dev/null +++ b/sma/speedwire.h @@ -0,0 +1,301 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + +#ifndef SPEEDWIRE_H +#define SPEEDWIRE_H + +#include +#include +#include +#include +#include + +class Speedwire +{ + Q_GADGET +public: + enum Command { + CommandIdentify = 0x00000201, + CommandQueryStatus = 0x51800200, + CommandQueryAc = 0x51000200, + CommandQueryDc = 0x53800200, + CommandQueryEnergy = 0x54000200, + CommandQueryDevice = 0x58000200, + CommandQueryDeviceResponse = 58000201, + CommandLogin = 0xfffd040c, + CommandLogout = 0xfffd010e, + CommandLoginResponse = 0x0ffdf40d + }; + Q_ENUM(Command) + + enum ProtocolId { + ProtocolIdUnknown = 0x0000, + ProtocolIdMeter = 0x6069, + ProtocolIdInverter = 0x6065, + ProtocolIdDiscoveryResponse = 0x0001, + ProtocolIdDiscovery = 0xffff + }; + Q_ENUM(ProtocolId) + + enum DeviceClass { + DeviceClassUnknown = 0x0000, + DeviceClassAllDevices = 0x1f40, + DeviceClassSolarInverter = 0x1f41, + DeviceClassWindTurbine = 0x1f42, + DeviceClassBatteryInverter = 0x1f47, + DeviceClassConsumer = 0x1f61, + DeviceClassSensorSystem = 0x1f80, + DeviceClassElectricityMeter = 0x1f81, + DeviceClassCommunicationProduct = 0x1fc0 + }; + Q_ENUM(DeviceClass) + + class Header + { + public: + Header() = default; + quint32 smaSignature = 0; + quint16 headerLength = 0; + quint16 tagType = 0; + quint16 tagVersion = 0; + quint16 group = 0; + quint16 payloadLength = 0; + quint16 smaNet2Version = 0; + ProtocolId protocolId = ProtocolIdUnknown; + + inline bool isValid() const { + return smaSignature == Speedwire::smaSignature() && protocolId != ProtocolIdUnknown; + } + }; + + typedef struct InverterPackage { + quint8 wordCount = 0; + quint8 control = 0; + quint16 destinationModelId = 0; + quint32 destinationSerialNumber = 0; + quint16 destinationControl = 0; + quint16 sourceModelId = 0; + quint32 sourceSerialNumber = 0; + quint16 sourceControl = 0; + quint16 errorCode = 0; + quint16 fragmentId = 0; + quint16 packetId = 0; + quint32 command = 0; + } InverterPackage; + + Speedwire() = default; + + //static QHash deviceTypes = { {0x0000, "Unknwon"} }; + + static quint16 port() { return 9522; } + static QHostAddress multicastAddress() { return QHostAddress("239.12.255.254"); } + static quint32 smaSignature() { return 0x534d4100; } + static quint16 tag0() { return 0x02a0; } + static quint16 tagVersion() { return 0; } + static quint16 smaNet2Version() { return 0x0010; } + + static QString getModelName(quint16 modelIdentifier) { + switch (modelIdentifier) { + case 9015: return "SB 700"; + case 9016: return "SB 700U"; + case 9017: return "SB 1100"; + case 9018: return "SB 1100U"; + case 9019: return "SB 1100LV"; + case 9020: return "SB 1700"; + case 9021: return "SB 1900TLJ"; + case 9022: return "SB 2100TL"; + case 9023: return "SB 2500"; + case 9024: return "SB 2800"; + case 9025: return "SB 2800i"; + case 9026: return "SB 3000"; + case 9027: return "SB 3000US"; + case 9028: return "SB 3300"; + case 9029: return "SB 3300U"; + case 9030: return "SB 3300TL"; + case 9031: return "SB 3300TL HC"; + case 9032: return "SB 3800"; + case 9033: return "SB 3800U"; + case 9034: return "SB 4000US"; + case 9035: return "SB 4200TL"; + case 9036: return "SB 4200TL HC"; + case 9037: return "SB 5000TL"; + case 9038: return "SB 5000TLW"; + case 9039: return "SB 5000TL HC"; + case 9066: return "SB 1200"; + case 9067: return "STP 10000TL-10"; + case 9068: return "STP 12000TL-10"; + case 9069: return "STP 15000TL-10"; + case 9070: return "STP 17000TL-10"; + case 9084: return "WB 3600TL-20"; + case 9085: return "WB 5000TL-20"; + case 9086: return "SB 3800US-10"; + case 9098: return "STP 5000TL-20"; + case 9099: return "STP 6000TL-20"; + case 9100: return "STP 7000TL-20"; + case 9101: return "STP 8000TL-10"; + case 9102: return "STPcase 9000TL-20"; + case 9103: return "STP 8000TL-20"; + case 9104: return "SB 3000TL-JP-21"; + case 9105: return "SB 3500TL-JP-21"; + case 9106: return "SB 4000TL-JP-21"; + case 9107: return "SB 4500TL-JP-21"; + case 9108: return "SCSMC"; + case 9109: return "SB 1600TL-10"; + case 9131: return "STP 20000TL-10"; + case 9139: return "STP 20000TLHE-10"; + case 9140: return "STP 15000TLHE-10"; + case 9157: return "Sunny Island 2012"; + case 9158: return "Sunny Island 2224"; + case 9159: return "Sunny Island 5048"; + case 9160: return "SB 3600TL-20"; + case 9168: return "SC630HE-11"; + case 9169: return "SC500HE-11"; + case 9170: return "SC400HE-11"; + case 9171: return "WB 3000TL-21"; + case 9172: return "WB 3600TL-21"; + case 9173: return "WB 4000TL-21"; + case 9174: return "WB 5000TL-21"; + case 9175: return "SC 250"; + case 9176: return "SMA Meteo Station"; + case 9177: return "SB 240-10"; + case 9179: return "Multigate-10"; + case 9180: return "Multigate-US-10"; + case 9181: return "STP 20000TLEE-10"; + case 9182: return "STP 15000TLEE-10"; + case 9183: return "SB 2000TLST-21"; + case 9184: return "SB 2500TLST-21"; + case 9185: return "SB 3000TLST-21"; + case 9186: return "WB 2000TLST-21"; + case 9187: return "WB 2500TLST-21"; + case 9188: return "WB 3000TLST-21"; + case 9189: return "WTP 5000TL-20"; + case 9190: return "WTP 6000TL-20"; + case 9191: return "WTP 7000TL-20"; + case 9192: return "WTP 8000TL-20"; + case 9193: return "WTPcase 9000TL-20"; + case 9254: return "Sunny Island 3324"; + case 9255: return "Sunny Island 4.0M"; + case 9256: return "Sunny Island 4248"; + case 9257: return "Sunny Island 4248U"; + case 9258: return "Sunny Island 4500"; + case 9259: return "Sunny Island 4548U"; + case 9260: return "Sunny Island 5.4M"; + case 9261: return "Sunny Island 5048U"; + case 9262: return "Sunny Island 6048U"; + case 9278: return "Sunny Island 3.0M"; + case 9279: return "Sunny Island 4.4M"; + case 9281: return "STP 10000TL-20"; + case 9282: return "STP 11000TL-20"; + case 9283: return "STP 12000TL-20"; + case 9284: return "STP 20000TL-30"; + case 9285: return "STP 25000TL-30"; + case 9301: return "SB1.5-1VL-40"; + case 9302: return "SB2.5-1VL-40"; + case 9303: return "SB2.0-1VL-40"; + case 9304: return "SB5.0-1SP-US-40"; + case 9305: return "SB6.0-1SP-US-40"; + case 9306: return "SB8.0-1SP-US-40"; + case 9307: return "Energy Meter"; + default: return "Unknown"; + } + }; + + // Multicast device discovery request packet, according to SMA documentation. + // However, this does not seem to be supported anymore with version 3.x devices + // 0x53, 0x4d, 0x41, 0x00, 0x00, 0x04, 0x02, 0xa0, // sma signature, tag0 + // 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x20, // 0xffffffff group, 0x0000 length, 0x0020 "SMA Net ?", Version ? + // 0x00, 0x00, 0x00, 0x00 // 0x0000 protocol, 0x00 #long words, 0x00 ctrl + + // Unicast device discovery request packet, according to SMA documentation + // 0x53, 0x4d, 0x41, 0x00, 0x00, 0x04, 0x02, 0xa0, // sma signature, tag0 + // 0x00, 0x00, 0x00, 0x01, 0x00, 0x26, 0x00, 0x10, // 0x26 length, 0x0010 "SMA Net 2", Version 0 + // 0x60, 0x65, 0x09, 0xa0, 0xff, 0xff, 0xff, 0xff, // 0x6065 protocol, 0x09 #long words, 0xa0 ctrl, 0xffff dst susyID any, 0xffffffff dst serial any + // 0xff, 0xff, 0x00, 0x00, 0x7d, 0x00, 0x52, 0xbe, // 0x0000 dst cntrl, 0x007d src susy id, 0x3a28be52 src serial + // 0x28, 0x3a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // 0x0000 src cntrl, 0x0000 error code, 0x0000 fragment ID + // 0x01, 0x80, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, // 0x8001 packet ID + // 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + // 0x00, 0x00 + + static QByteArray discoveryDatagramMulticast() { return QByteArray::fromHex("534d4100000402a0ffffffff0000002000000000"); } + static QByteArray discoveryResponseDatagram() { return QByteArray::fromHex("534d4100000402A000000001000200000001"); } + static QByteArray discoveryDatagramUnicast() { return QByteArray::fromHex("534d4100000402a00000000100260010606509a0ffffffffffff00007d0052be283a000000000000018000020000000000000000000000000000"); } + + static Speedwire::Header parseHeader(QDataStream &stream) { + stream.setByteOrder(QDataStream::BigEndian); + Header header; + quint16 protocolId; + stream >> header.smaSignature >> header.headerLength; + stream >> header.tagType >> header.tagVersion >> header.group; + stream >> header.payloadLength >> header.smaNet2Version; + stream >> protocolId; + header.protocolId = static_cast(protocolId); + return header; + }; + + static Speedwire::InverterPackage parseInverterPackage(QDataStream &stream) { + // Make sure the data stream is little endian + stream.setByteOrder(QDataStream::LittleEndian); + InverterPackage package; + stream >> package.wordCount; + stream >> package.control; + stream >> package.destinationModelId; + stream >> package.destinationSerialNumber; + stream >> package.destinationControl; + stream >> package.sourceModelId; + stream >> package.sourceSerialNumber; + stream >> package.sourceControl; + stream >> package.errorCode; + stream >> package.fragmentId; + stream >> package.packetId; + stream >> package.command; + return package; + }; +}; + +inline QDebug operator<<(QDebug debug, const Speedwire::Header &header) +{ + debug.nospace() << "SpeedwireHeader(" << header.protocolId << ", payload size: " << header.payloadLength << ", group: " << header.payloadLength << ")"; + return debug.maybeSpace(); +} + +inline QDebug operator<<(QDebug debug, const Speedwire::InverterPackage &package) +{ + debug.nospace() << "InverterPackage(" << package.sourceSerialNumber; + debug.nospace() << ", Model ID: " << package.sourceModelId; + debug.nospace() << ", command: " << package.command; + debug.nospace() << ", error: " << package.errorCode; + debug.nospace() << ", fragment: " << package.fragmentId; + debug.nospace() << ", package ID: " << package.fragmentId; + debug.nospace() << ")"; + return debug.maybeSpace(); +} + + +#endif // SPEEDWIRE_H diff --git a/sma/speedwirediscovery.cpp b/sma/speedwirediscovery.cpp index be92340a..6ae02bfa 100644 --- a/sma/speedwirediscovery.cpp +++ b/sma/speedwirediscovery.cpp @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #include "speedwirediscovery.h" #include "extern-plugininfo.h" @@ -11,36 +41,10 @@ SpeedwireDiscovery::SpeedwireDiscovery(NetworkDeviceDiscovery *networkDeviceDisc // More details: https://github.com/RalfOGit/libspeedwire/ - // //! Multicast device discovery request packet, according to SMA documentation. - // //! However, this does not seem to be supported anymore with version 3.x devices - // const unsigned char multicast_request[] = { - // 0x53, 0x4d, 0x41, 0x00, 0x00, 0x04, 0x02, 0xa0, // sma signature, tag0 - // 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x20, // 0xffffffff group, 0x0000 length, 0x0020 "SMA Net ?", Version ? - // 0x00, 0x00, 0x00, 0x00 // 0x0000 protocol, 0x00 #long words, 0x00 ctrl - // }; - - // //! Unicast device discovery request packet, according to SMA documentation - // const unsigned char unicast_request[] = { - // 0x53, 0x4d, 0x41, 0x00, 0x00, 0x04, 0x02, 0xa0, // sma signature, tag0 - // 0x00, 0x00, 0x00, 0x01, 0x00, 0x26, 0x00, 0x10, // 0x26 length, 0x0010 "SMA Net 2", Version 0 - // 0x60, 0x65, 0x09, 0xa0, 0xff, 0xff, 0xff, 0xff, // 0x6065 protocol, 0x09 #long words, 0xa0 ctrl, 0xffff dst susyID any, 0xffffffff dst serial any - // 0xff, 0xff, 0x00, 0x00, 0x7d, 0x00, 0x52, 0xbe, // 0x0000 dst cntrl, 0x007d src susy id, 0x3a28be52 src serial - // 0x28, 0x3a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // 0x0000 src cntrl, 0x0000 error code, 0x0000 fragment ID - // 0x01, 0x80, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, // 0x8001 packet ID - // 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - // 0x00, 0x00 - // }; // // Request: 534d4100000402a00000000100260010 606509a0 ffffffffffff0000 7d0052be283a0000 000000000180 00020000 00000000 00000000 00000000 => command = 0x00000200, first = 0x00000000; last = 0x00000000; trailer = 0x00000000 // // Response 534d4100000402a000000001004e0010 606513a0 7d0052be283a00c0 7a01842a71b30000 000000000180 01020000 00000000 00000000 00030000 00ff0000 00000000 01007a01 842a71b3 00000a00 0c000000 00000000 00000000 01010000 00000000 - - - - - - - // qCDebug(dcSma()) << "SpeedwireDiscovery: Create speed wire interface for multicast" << m_multicastAddress.toString() << "on port" << m_port; // QByteArray exampleData = QByteArray::fromHex("534d4100000402a000000001024400106069010e714369aee618a41600010400000000000001080000000021391229100002040000004415000208000000001575a137d800030400000000000003080000000003debed0e800040400000017c6000408000000001008c2070000090400000000000009080000000027c77bed20000a04000000481d000a08000000001722823410000d0400000003b00015040000000000001508000000000d1e1e0e3000160400000015120016080000000006c5a2d8b800170400000000000017080000000001bd6f680000180400000007990018080000000004def712b8001d040000000000001d08000000000eeefaafd0001e040000001666001e0800000000074b38bf88001f040000000a300020040000037bcb00210400000003ad0029040000000000002908000000000a9b1afec8002a040000001a81002a08000000000803e62b88002b040000000000002b080000000001511459b8002c0400000006d5002c0800000000052c8455b80031040000000000003108000000000cf83b37100032040000001b5f0032080000000008a6e257f80033040000000c3f003404000003747900350400000003c8003d040000000000003d08000000000a53d0ba08003e040000001482003e080000000007800fd188003f040000000000003f080000000001185820c8004004000000095800400800000000064563b1900045040000000000004508000000000d26d3eae0004604000000168900460800000000082b4fc5a80047040000000a440048040000037ed1004904000000038e900000000102085200000000"); // processDatagram(QHostAddress("127.0.0.1"), m_port, exampleData); @@ -160,7 +164,7 @@ void SpeedwireDiscovery::startMulticastDiscovery() void SpeedwireDiscovery::sendUnicastDiscoveryRequest(const QHostAddress &targetHostAddress) { - if (m_unicastSocket->writeDatagram(m_discoveryDatagramUnicast, targetHostAddress, m_port) < 0) { + if (m_unicastSocket->writeDatagram(Speedwire::discoveryDatagramUnicast(), targetHostAddress, m_port) < 0) { qCWarning(dcSma()) << "SpeedwireDiscovery: Failed to send unicast discovery datagram to address" << targetHostAddress.toString(); return; } @@ -222,38 +226,25 @@ void SpeedwireDiscovery::processDatagram(const QHostAddress &senderAddress, quin } // Ignore discovery requests - if (datagram == m_discoveryDatagramMulticast || datagram == m_discoveryDatagramUnicast) + if (datagram == Speedwire::discoveryDatagramMulticast() || datagram == Speedwire::discoveryDatagramUnicast()) return; QDataStream stream(datagram); - stream.setByteOrder(QDataStream::BigEndian); - - SpeedwireInterface::SpeedwireHeader header = SpeedwireInterface::parseHeader(stream); + Speedwire::Header header = Speedwire::parseHeader(stream); if (!header.isValid()) { qCWarning(dcSma()) << "SpeedwireDiscovery: Datagram header is not valid. Ignoring data..."; return; } - // Example data: - // 534d4100 0004 02a0 0000 0001 0244 0010 6069 010e 7143 69ae e618a416 00010400000000000001080000000021391229100002040000004415000208000000001575a137d800030400000000000003080000000003debed0e800040400000017c6000408000000001008c2070000090400000000000009080000000027c77bed20000a04000000481d000a08000000001722823410000d0400000003b00015040000000000001508000000000d1e1e0e3000160400000015120016080000000006c5a2d8b800170400000000000017080000000001bd6f680000180400000007990018080000000004def712b8001d040000000000001d08000000000eeefaafd0001e040000001666001e0800000000074b38bf88001f040000000a300020040000037bcb00210400000003ad0029040000000000002908000000000a9b1afec8002a040000001a81002a08000000000803e62b88002b040000000000002b080000000001511459b8002c0400000006d5002c0800000000052c8455b80031040000000000003108000000000cf83b37100032040000001b5f0032080000000008a6e257f80033040000000c3f003404000003747900350400000003c8003d040000000000003d08000000000a53d0ba08003e040000001482003e080000000007800fd188003f040000000000003f080000000001185820c8004004000000095800400800000000064563b1900045040000000000004508000000000d26d3eae0004604000000168900460800000000082b4fc5a80047040000000a440048040000037ed1004904000000038e900000000102085200000000 + qCDebug(dcSma()) << "SpeedwireDiscovery:" << header; - - qCDebug(dcSma()) << "SpeedwireDiscovery: ======================= Header"; - qCDebug(dcSma()) << "SpeedwireDiscovery: Length:" << header.headerLength; - qCDebug(dcSma()) << "SpeedwireDiscovery: Tag0:" << header.tagType; - qCDebug(dcSma()) << "SpeedwireDiscovery: Tag0 version:" << header.tagVersion; - qCDebug(dcSma()) << "SpeedwireDiscovery: Group:" << header.group << (header.group == 1 ? "(default group)" : ""); - qCDebug(dcSma()) << "SpeedwireDiscovery: Data length:" << header.payloadLength << datagram.length(); - qCDebug(dcSma()) << "SpeedwireDiscovery: SMA Net 2 Version" << header.smaNet2Version; - qCDebug(dcSma()) << "SpeedwireDiscovery: Protocol ID" << header.protocolId; - - if (header.protocolId == SpeedwireInterface::ProtocolIdDiscoveryResponse) { + if (header.protocolId == Speedwire::ProtocolIdDiscoveryResponse) { qCDebug(dcSma()) << "SpeedwireDiscovery: Received discovery response from" << QString("%1:%2").arg(senderAddress.toString()).arg(senderPort); - // Response: 534d4100 0004 02a0 0000 0001 0002 0000 0001 - // "192.168.178.25:9522" "534d4100 0004 02a0 0000 0001 0002 0000 0001 0004 0010 0001 0003 0004 0020 0000 0001 0004 0030 c0a8 b219 0004 0040 0000 0000 0002 0070 ef0c 00000000" - // "192.168.178.22:9522" "534d4100 0004 02a0 0000 0001 0002 0000 0001 0004 0010 0001 0001 0004 0020 0000 0001 0004 0030 c0a8 b216 0004 0040 0000 0001 00000000" - if (!datagram.startsWith(m_discoveryResponseDatagram)) { + // "534d4100 0004 02a0 0000 0001 0002 0000 0001 0004 0010 0001 0003 0004 0020 0000 0001 0004 0030 c0a8 b219 0004 0040 0000 0000 0002 0070 ef0c 00000000" + // "534d4100 0004 02a0 0000 0001 0002 0000 0001 0004 0010 0001 0001 0004 0020 0000 0001 0004 0030 c0a8 b216 0004 0040 0000 0001 00000000" + + if (!datagram.startsWith(Speedwire::discoveryResponseDatagram())) { qCWarning(dcSma()) << "SpeedwireDiscovery: Received discovery reply but the message start does not match the required schema. Ignoring data..."; return; } @@ -265,7 +256,6 @@ void SpeedwireDiscovery::processDatagram(const QHostAddress &senderAddress, quin return; } - SpeedwireDiscoveryResult result; result.address = senderAddress; if (m_networkDeviceInfos.hasHostAddress(senderAddress)) { @@ -283,14 +273,12 @@ void SpeedwireDiscovery::processDatagram(const QHostAddress &senderAddress, quin // We received SMA data, let's parse depending on the protocol id - if (header.protocolId == SpeedwireInterface::ProtocolIdMeter) { + if (header.protocolId == Speedwire::ProtocolIdMeter) { // Example: 010e 714369ae quint16 modelId; quint32 serialNumber; stream >> modelId >> serialNumber; - qCDebug(dcSma()) << "SpeedwireDiscovery: ======================= Meter identifier"; - qCDebug(dcSma()) << "SpeedwireDiscovery: Model ID:" << modelId; - qCDebug(dcSma()) << "SpeedwireDiscovery: Serial number:" << serialNumber; + qCDebug(dcSma()) << "SpeedwireDiscovery: Meter identifier: Model ID:" << modelId << "Serial number:" << serialNumber; if (!m_results.contains(senderAddress)) { SpeedwireDiscoveryResult result; @@ -305,13 +293,10 @@ void SpeedwireDiscovery::processDatagram(const QHostAddress &senderAddress, quin m_results[senderAddress].modelId = modelId; m_results[senderAddress].serialNumber = serialNumber; - } else if (header.protocolId == SpeedwireInterface::ProtocolIdInverter) { - quint16 modelId; - quint32 serialNumber; - stream >> modelId >> serialNumber; - qCDebug(dcSma()) << "SpeedwireDiscovery: ======================= Inverter identifier"; - qCDebug(dcSma()) << "SpeedwireDiscovery: Model ID:" << modelId; - qCDebug(dcSma()) << "SpeedwireDiscovery: Serial number:" << serialNumber; + } else if (header.protocolId == Speedwire::ProtocolIdInverter) { + Speedwire::InverterPackage inverterPackage = Speedwire::parseInverterPackage(stream); + // Response from inverter 534d4100 0004 02a0 0000 0001 004e 0010 6065 1390 7d00 52be283a 0000 b500 c2c12e12 0000 0000 00000 1800102000000000000000000000003000000ff0000ecd5ff1f0100b500c2c12e1200000a000c00000000000000030000000101000000000000 + qCDebug(dcSma()) << "SpeedwireDiscovery:" << inverterPackage; if (!m_results.contains(senderAddress)) { SpeedwireDiscoveryResult result; @@ -324,18 +309,17 @@ void SpeedwireDiscovery::processDatagram(const QHostAddress &senderAddress, quin m_results[senderAddress].networkDeviceInfo = m_networkDeviceInfos.get(senderAddress); } - m_results[senderAddress].modelId = modelId; - m_results[senderAddress].serialNumber = serialNumber; + m_results[senderAddress].modelId = inverterPackage.sourceModelId; + m_results[senderAddress].serialNumber = inverterPackage.sourceSerialNumber; } else { qCWarning(dcSma()) << "SpeedwireDiscovery: Unhandled data received" << datagram.toHex(); return; } - } void SpeedwireDiscovery::sendDiscoveryRequest() { - if (m_multicastSocket->writeDatagram(m_discoveryDatagramMulticast, m_multicastAddress, m_port) < 0) { + if (m_multicastSocket->writeDatagram(Speedwire::discoveryDatagramMulticast(), m_multicastAddress, m_port) < 0) { qCWarning(dcSma()) << "SpeedwireDiscovery: Failed to send discovery datagram to multicast address" << m_multicastAddress.toString(); return; } @@ -360,6 +344,5 @@ void SpeedwireDiscovery::onDiscoveryProcessFinished() qCDebug(dcSma()) << "SpeedwireDiscovery: Serial number:" << result.serialNumber; } - emit discoveryFinished(); } diff --git a/sma/speedwirediscovery.h b/sma/speedwirediscovery.h index c1da61e2..3c443431 100644 --- a/sma/speedwirediscovery.h +++ b/sma/speedwirediscovery.h @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #ifndef SPEEDWIREDISCOVERY_H #define SPEEDWIREDISCOVERY_H @@ -7,6 +37,7 @@ #include +#include "speedwire.h" #include "speedwireinterface.h" class SpeedwireDiscovery : public QObject @@ -39,8 +70,8 @@ private: NetworkDeviceDiscovery *m_networkDeviceDiscovery = nullptr; QUdpSocket *m_multicastSocket = nullptr; QUdpSocket *m_unicastSocket = nullptr; - QHostAddress m_multicastAddress = QHostAddress("239.12.255.254"); - quint16 m_port = 9522; + QHostAddress m_multicastAddress = Speedwire::multicastAddress(); + quint16 m_port = Speedwire::port(); bool m_initialized = false; // Discovery @@ -49,12 +80,6 @@ private: NetworkDeviceInfos m_networkDeviceInfos; QHash m_results; - // Static discovery datagrams for speedwire - QByteArray m_discoveryDatagramMulticast = QByteArray::fromHex("534d4100000402a0ffffffff0000002000000000"); - QByteArray m_discoveryResponseDatagram = QByteArray::fromHex("534d4100000402A000000001000200000001"); - - QByteArray m_discoveryDatagramUnicast = QByteArray::fromHex("534d4100000402a00000000100260010606509a0ffffffffffff00007d0052be283a000000000000018000020000000000000000000000000000"); - void startMulticastDiscovery(); void sendUnicastDiscoveryRequest(const QHostAddress &targetHostAddress); diff --git a/sma/speedwireinterface.cpp b/sma/speedwireinterface.cpp index 23001852..4d7196aa 100644 --- a/sma/speedwireinterface.cpp +++ b/sma/speedwireinterface.cpp @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #include "speedwireinterface.h" #include "extern-plugininfo.h" @@ -43,10 +73,10 @@ void SpeedwireInterface::deinitialize() if (!m_socket->leaveMulticastGroup(m_multicastAddress)) { qCWarning(dcSma()) << "SpeedwireInterface: Failed to leave multicast group" << m_multicastAddress.toString(); } - - m_socket->close(); - m_initialized = false; } + + m_socket->close(); + m_initialized = false; } } @@ -65,22 +95,12 @@ quint32 SpeedwireInterface::sourceSerialNumber() const return m_sourceSerialNumber; } -SpeedwireInterface::SpeedwireHeader SpeedwireInterface::parseHeader(QDataStream &stream) -{ - SpeedwireHeader header; - quint16 protocolId; - stream >> header.smaSignature >> header.headerLength; - stream >> header.tagType >> header.tagVersion >> header.group; - stream >> header.payloadLength >> header.smaNet2Version; - stream >> protocolId; - header.protocolId = static_cast(protocolId); - return header; -} - void SpeedwireInterface::sendData(const QByteArray &data) { - //qCDebug(dcSma()) << "Send data:" << data.toHex(); - m_socket->writeDatagram(data, m_address, m_port); + qCDebug(dcSma()) << "SpeedwireInterface: -->" << m_address.toString() << m_port << data.toHex(); + if (m_socket->writeDatagram(data, m_address, m_port) < 0) { + qCWarning(dcSma()) << "SpeedwireInterface: failed to send data" << m_socket->errorString(); + } } void SpeedwireInterface::readPendingDatagrams() diff --git a/sma/speedwireinterface.h b/sma/speedwireinterface.h index bd240edd..664ce4a5 100644 --- a/sma/speedwireinterface.h +++ b/sma/speedwireinterface.h @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #ifndef SPEEDWIREINTERFACE_H #define SPEEDWIREINTERFACE_H @@ -5,19 +35,12 @@ #include #include +#include "speedwire.h" + class SpeedwireInterface : public QObject { Q_OBJECT public: - enum ProtocolId { - ProtocolIdUnknown = 0x0000, - ProtocolIdMeter = 0x6069, - ProtocolIdInverter = 0x6065, - ProtocolIdDiscoveryResponse = 0x0001, - ProtocolIdDiscovery = 0xffff - }; - Q_ENUM(ProtocolId) - enum DeviceType { DeviceTypeUnknown, DeviceTypeMeter, @@ -25,24 +48,6 @@ public: }; Q_ENUM(DeviceType) - class SpeedwireHeader - { - public: - SpeedwireHeader() = default; - quint32 smaSignature = 0; - quint16 headerLength = 0; - quint16 tagType = 0; - quint16 tagVersion = 0; - quint16 group = 0; - quint16 payloadLength = 0; - quint16 smaNet2Version = 0; - ProtocolId protocolId = ProtocolIdUnknown; - - inline bool isValid() const { - return smaSignature == 0x534d4100 && protocolId != ProtocolIdUnknown; - } - }; - explicit SpeedwireInterface(const QHostAddress &address, bool multicast, QObject *parent = nullptr); ~SpeedwireInterface(); @@ -54,8 +59,6 @@ public: quint16 sourceModelId() const; quint32 sourceSerialNumber() const; - static SpeedwireInterface::SpeedwireHeader parseHeader(QDataStream &stream); - public slots: void sendData(const QByteArray &data); @@ -65,14 +68,14 @@ signals: private: QUdpSocket *m_socket = nullptr; QHostAddress m_address; - quint16 m_port = 9522; - QHostAddress m_multicastAddress = QHostAddress("239.12.255.254"); + quint16 m_port = Speedwire::port(); + QHostAddress m_multicastAddress = Speedwire::multicastAddress(); bool m_multicast = false; bool m_initialized = false; // Requester quint16 m_sourceModelId = 0x007d; - quint32 m_sourceSerialNumber = 0x3a28be42; + quint32 m_sourceSerialNumber = 0x3a28be52; private slots: void readPendingDatagrams(); @@ -81,4 +84,5 @@ private slots: }; + #endif // SPEEDWIREINTERFACE_H diff --git a/sma/speedwireinverter.cpp b/sma/speedwireinverter.cpp index 1184abfe..24c90b06 100644 --- a/sma/speedwireinverter.cpp +++ b/sma/speedwireinverter.cpp @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #include "speedwireinverter.h" #include "extern-plugininfo.h" @@ -10,9 +40,416 @@ SpeedwireInverter::SpeedwireInverter(const QHostAddress &address, quint16 modelI m_serialNumber(serialNumber) { - m_interface = new SpeedwireInterface(m_address, true, this); + qCDebug(dcSma()) << "Inverter: setup interface on" << m_address.toString(); + m_interface = new SpeedwireInterface(m_address, false, this); connect(m_interface, &SpeedwireInterface::dataReceived, this, &SpeedwireInverter::processData); +} + +bool SpeedwireInverter::initialize() +{ + return m_interface->initialize(); +} + +bool SpeedwireInverter::initialized() const +{ + return m_interface->initialized(); +} + +SpeedwireInverter::State SpeedwireInverter::state() const +{ + return m_state; +} + +bool SpeedwireInverter::reachable() const +{ + return m_reachable; +} + +QString SpeedwireInverter::modelName() const +{ + return m_modelName; +} + +double SpeedwireInverter::totalAcPower() const +{ + return m_totalAcPower; +} + +double SpeedwireInverter::gridFrequency() const +{ + return m_gridFrequency; +} + +double SpeedwireInverter::totalEnergyProduced() const +{ + return m_totalEnergyProduced; +} + +double SpeedwireInverter::todayEnergyProduced() const +{ + return m_todayEnergyProduced; +} + +double SpeedwireInverter::voltageAcPhase1() const +{ + return m_voltageAcPhase1; +} + +double SpeedwireInverter::voltageAcPhase2() const +{ + return m_voltageAcPhase2; +} + +double SpeedwireInverter::voltageAcPhase3() const +{ + return m_voltageAcPhase3; +} + +double SpeedwireInverter::currentAcPhase1() const +{ + return m_currentAcPhase1; +} + +double SpeedwireInverter::currentAcPhase2() const +{ + return m_currentAcPhase2; +} + +double SpeedwireInverter::currentAcPhase3() const +{ + return m_currentAcPhase3; +} + +double SpeedwireInverter::powerAcPhase1() const +{ + return m_powerAcPhase1; +} + +double SpeedwireInverter::powerAcPhase2() const +{ + return m_powerAcPhase2; +} + +double SpeedwireInverter::powerAcPhase3() const +{ + return m_powerAcPhase3; +} + +double SpeedwireInverter::powerDcMpp1() const +{ + return m_powerDcMpp1; +} + +double SpeedwireInverter::powerDcMpp2() const +{ + return m_powerDcMpp2; +} + +SpeedwireInverterReply *SpeedwireInverter::sendIdentifyRequest() +{ + // Request 534d4100000402a000000001002600106065 09 a0 ffff ffffffff 0000 7d00 52be283a 0000 0000 0000 0180 00020000 000000000000000000000000 + // Response 534d4100000402a000000001004e00106065 13 90 7d00 52be283a 0000 b500 c2c12e12 0000 0000 0000 0180 01020000 00000000000000000003000000ff0000ecd5ff1f0100b500c2c12e1200000a000c00000000000000030000000101000000000000 + + qCDebug(dcSma()) << "Inverter: Sending identify request to" << m_address.toString(); + SpeedwireInverterRequest request; + request.setPacketId(0x8001); + request.setCommand(Speedwire::CommandIdentify); + request.setRequestData(Speedwire::discoveryDatagramUnicast()); + return createReply(request); +} + +SpeedwireInverterReply *SpeedwireInverter::sendLoginRequest(const QString &password, bool loginAsUser) +{ + qCDebug(dcSma()) << "Inverter: Sending login request as" << (loginAsUser ? "user" : "installer") << "using password" << password; + + // Request: 534d4100000402a000000001003a001060650ea0 b500 c2c12e12 0001 7d00 52be283a 0001 0000 0000 0180 0c04fdff0 7000000 84030000 3408b261 00000000 b8b8b8b8888888888888888800000000 // Login request + + // Response: 534d4100000402a000000001003a001060650ed0 7d00 52be283a 0001 b500 c2c12e12 0001 0000000001800 d04fdff0 7000000 84030000 3408b261 00000000 b8b8b8b8888888888888888800000000 // Login OK + // Response: 534d4100000402a000000001003a001060650ed0 7d00 52be283a 0001 b500 c2c12e12 0001 0001000001800 d04fdff0 7000000 84030000 b709b261 00000000 b8b8b8b9888888888888888800000000 // Login FAILED, error 1 + + // Build the header + QByteArray datagram; + QDataStream stream(&datagram, QIODevice::WriteOnly); + buildDefaultHeader(stream, 58, 0xa0); + + // Reset the packet id counter, otherwise there will be no response + //m_packetId = 0; + quint16 packetId = m_packetId++ | 0x8000; + Speedwire::Command command = Speedwire::CommandLogin; + + // The payload is little endian encoded + buildPackage(stream, command, packetId); + + // User type: 7 = user, a = installer + stream << (loginAsUser ? static_cast(0x00000007) : static_cast(0x0000000a)); + // Timeout + stream << static_cast(900); // 900 ms + // Current time + stream << static_cast(QDateTime::currentMSecsSinceEpoch() / 1000.0); + // Zeros + stream << static_cast(0); + + // Encode password + QByteArray passwordData = password.toUtf8(); + QByteArray encodedPassword(12, loginAsUser ? 0x88 : 0xBB); + for (int i = 0; i < password.count(); i++) { + encodedPassword[i] = (passwordData.at(i) + (loginAsUser ? 0x88 : 0xBB) % 0xff); + } + + // Add endoced password + for (int i = 0; i < encodedPassword.count(); i++) { + stream << static_cast(encodedPassword.at(i)); + } + + // End of data + stream << static_cast(0); + + // Final datagram + SpeedwireInverterRequest request; + request.setPacketId(packetId); + request.setCommand(command); + request.setRequestData(datagram); + return createReply(request); +} + +SpeedwireInverterReply *SpeedwireInverter::sendLogoutRequest() +{ + // Request 534d4100000402a000000001 0022 0010 6065 08a0 ffffffffffff0003 7d0052be283a0003 00000000 0280 0e01fdff ffffffff 00000000 => logoff command = 0xfffd01e0 + + // 534d4100000402a000000001 0022 0010 6065 08a0 ffffffffffff0003 7d0052be283a0003 00000000 0480 0e01fdff ffffffff 00000000 + + // Request 534d4100000402a000000001 0022 0010 6065 08a0 ffffffffffff0003 7d0040be283a0003 000000000380 e001fdff ffffffff 00000000 + // Request 534d4100000402a000000001 0022 0010 6065 08a0 ffffffffffff0003 7d0042be283a0003 000000000180 e001fdff ffffffff 00000000 + // 534d4100000402a000000001 0022 0010 6065 08a0 ffffffffffff0003 7d0052be283a0003 000000000080 0e01fdff ffffffff 00000000 + + // Build the header + QByteArray datagram; + QDataStream stream(&datagram, QIODevice::WriteOnly); + buildDefaultHeader(stream, 34); + + // Reset the packet id counter, otherwise there will be no response + quint16 packetId = m_packetId++ | 0x8000; + Speedwire::Command command = Speedwire::CommandLogout; + + // The payload is little endian encoded + stream.setByteOrder(QDataStream::LittleEndian); + + // Target + // stream << static_cast(m_modelId); + // stream << static_cast(m_serialNumber); + stream << static_cast(0xffff); + stream << static_cast(0xffffffff); + stream << static_cast(0x0300); + + // Source + stream << m_interface->sourceModelId(); + stream << m_interface->sourceSerialNumber(); + stream << static_cast(0x0300); + + stream << static_cast(0); + stream << static_cast(0); + stream << packetId; + + stream << command; + // Only first word + stream << static_cast(0xffffffff); + stream << static_cast(0); + + SpeedwireInverterRequest request; + request.setPacketId(packetId); + request.setCommand(command); + request.setRequestData(datagram); + request.setRetries(0); + return createReply(request); +} + +SpeedwireInverterReply *SpeedwireInverter::sendSoftwareVersionRequest() +{ + qCDebug(dcSma()) << "Inverter: Sending software version request to" << m_address.toString(); + + // Request 534d4100000402a00000000100260010 6065 09a0 7a01 842a71b3 0001 7d00 42be283a 0001 000000000380 00020058 00348200 ff348200 00000000 => query software version + // Response 534d4100000402a000000001004e0010 6065 13a0 7d00 42be283a 00a1 7a01 842a71b3 0001 000000000380 01020058 0a000000 0a000000 01348200 2ae5e65f 00000000 00000000 feffffff feffffff 040a1003 040a1003 00000000 00000000 00000000 code = 0x00823401 3 (BCD).10 (BCD).10 (BIN) Typ R (Enum) + + // Build the header + QByteArray datagram; + QDataStream stream(&datagram, QIODevice::WriteOnly); + buildDefaultHeader(stream, 38, 0xa0); + + // Reset the packet id counter, otherwise there will be no response + quint16 packetId = m_packetId++ | 0x8000; + Speedwire::Command command = Speedwire::CommandQueryDevice; + + // The payload is little endian encoded + buildPackage(stream, command, packetId); + + // First and last word + stream << static_cast(0x00823400); + stream << static_cast(0x008234ff); + + // End of data + stream << static_cast(0); + + // Final datagram + SpeedwireInverterRequest request; + request.setPacketId(packetId); + request.setCommand(command); + request.setRequestData(datagram); + return createReply(request); +} + +SpeedwireInverterReply *SpeedwireInverter::sendDeviceTypeRequest() +{ + qCDebug(dcSma()) << "Inverter: Sending software version request to" << m_address.toString(); + // Build the header + QByteArray datagram; + QDataStream stream(&datagram, QIODevice::WriteOnly); + buildDefaultHeader(stream, 38, 0xa0); + + // Reset the packet id counter, otherwise there will be no response + quint16 packetId = m_packetId++ | 0x8000; + Speedwire::Command command = Speedwire::CommandQueryDevice; + + // The payload is little endian encoded + buildPackage(stream, command, packetId); + + // 2 words + stream << static_cast(0x00821e00); + stream << static_cast(0x008220ff); + + // End of data + stream << static_cast(0); + + // Final datagram + SpeedwireInverterRequest request; + request.setPacketId(packetId); + request.setCommand(command); + request.setRequestData(datagram); + return createReply(request); +} + +void SpeedwireInverter::refresh() +{ + // Only refresh if not already busy... + if (m_state != StateIdle && m_state != StateDisconnected) + return; + + // Run the state machine + setState(StateInitializing); +} + +void SpeedwireInverter::sendNextReply() +{ + // Pending reply + if (m_currentReply) + return; + + // No reply left + if (m_replyQueue.isEmpty()) + return; + + // Pick the next reply and send request + m_currentReply = m_replyQueue.dequeue(); + qCDebug(dcSma()) << "Inverter: --> Sending" << m_currentReply->request().command() << "package ID:" << m_currentReply->request().packetId(); + m_interface->sendData(m_currentReply->request().requestData()); + m_currentReply->startWaiting(); +} + +SpeedwireInverterReply *SpeedwireInverter::createReply(const SpeedwireInverterRequest &request) +{ + SpeedwireInverterReply *reply = new SpeedwireInverterReply(request, this); + connect(reply, &SpeedwireInverterReply::timeout, this, &SpeedwireInverter::onReplyTimeout); + connect(reply, &SpeedwireInverterReply::finished, this, &SpeedwireInverter::onReplyFinished); + // Make sure the reply gets deleted once finished + connect(reply, &SpeedwireInverterReply::finished, reply, &SpeedwireInverterReply::deleteLater); + + // Schedule request + m_replyQueue.enqueue(reply); + sendNextReply(); + + return reply; +} + +void SpeedwireInverter::buildDefaultHeader(QDataStream &stream, quint16 payloadSize, quint8 control) +{ + // Header (big endian) + // 534d4100000402a00000000100260010606509a0 + + // 534d4100 : SMA\0 signature + // 0004 : header length + // 02a0 : Tag0 type + // 0000 : Tag version + // 0001 : Group + // 0026 : payload length + // 0010 : SMA Net 2 version + // 6065 : inverter protocol id + // 09 : length of long words = (payload length - 2) / 4 + // a0 : control ? + + stream.setByteOrder(QDataStream::BigEndian); + stream << Speedwire::smaSignature(); + stream << static_cast(4); // Header length + stream << Speedwire::tag0(); + stream << Speedwire::tagVersion(); + stream << static_cast(1); // Group 1 = default + stream << payloadSize; + stream << Speedwire::smaNet2Version(); + stream << static_cast(Speedwire::ProtocolIdInverter); + stream << static_cast((payloadSize - 2) / 4); // wordCount + stream << control; +} + +void SpeedwireInverter::buildPackage(QDataStream &stream, quint32 command, quint16 packetId) +{ + // ========= package header (little endian) + // == 7a01842a71b30001 + + // 7a01 : destination model id + // 842a71b3 : destination serial number + // 0001 : destination control field + + // == 7d0042be283a0001 + + // 7d00 : source model id + // 42be283a: source serial number + // 0001 : source control field + + // == 0000 0000 0380 00020058 + + // 0000 : error code + // 0000 : fragment id + // 0380 : packet id + // 00020058 : command id = CommandQueryDevice + + stream.setByteOrder(QDataStream::LittleEndian); + // Destination + stream << m_modelId << m_serialNumber; + // Destination Ctrl + stream << static_cast(0x0100); + // Source + stream << m_interface->sourceModelId() << m_interface->sourceSerialNumber(); + // Destination Ctrl + stream << static_cast(0x0100); + + // Packet information + quint16 errorCode = 0; + quint16 fragmentId = 0; + stream << errorCode << fragmentId << packetId; + + // Command + stream << static_cast(command); +} + +SpeedwireInverterReply *SpeedwireInverter::sendQueryRequest(Speedwire::Command command, quint32 firstWord, quint32 secondWord) +{ + qCDebug(dcSma()) << "Inverter: Sending query request to" << m_address.toString(); + + // Request 534d4100000402a00000000100260010 606509a0 7a01842a71b30001 7d0042be283a0001 000000000380 00020058 00348200 ff348200 00000000 => query software version + // Response 534d4100000402a000000001004e0010 606513a0 7d0042be283a00a1 7a01842a71b30001 000000000380 01020058 0a000000 0a000000 01348200 2ae5e65f 00000000 00000000 feffffff feffffff 040a1003 040a1003 00000000 00000000 00000000 code = 0x00823401 3 (BCD).10 (BCD).10 (BIN) Typ R (Enum) + // Request 534d4100000402a00000000100260010 606509a0 7a01842a71b30001 7d0042be283a0001 000000000480 00020058 001e8200 ff208200 00000000 => query device type + // Response 534d4100000402a000000001009e0010 606527a0 7d0042be283a00a1 7a01842a71b30001 000000000480 01020058 01000000 03000000 011e8210 6f89e95f 534e3a20 33303130 35333831 31360000 00000000 00000000 00000000 00000000 + // 011f8208 6f89e95f 411f0001 feffff00 00000000 00000000 00000000 00000000 00000000 00000000 => 1f41 solar inverter + // 01208208 6f89e95f 96240000 80240000 81240001 82240000 feffff00 00000000 00000000 00000000 00000000 // Request 534d4100000402a00000000100260010 606509a0 7a01842a71b30001 7d0042be283a0001 000000000480 00028053 001e2500 ff1e2500 00000000 => query spot dc power // Response 534d4100000402a000000001005e0010 606517a0 7d0042be283a00a1 7a01842a71b30001 000000000480 01028053 00000000 01000000 011e2540 61a7e95f 57000000 57000000 57000000 57000000 01000000 // 021e2540 61a7e95f 5e000000 5e000000 5e000000 5e000000 01000000 00000000 @@ -40,182 +477,783 @@ SpeedwireInverter::SpeedwireInverter(const QHostAddress &address, quint16 modelI // Response 534d4100000402a000000001004e0010 606513a0 7d0042be283a00a1 7a01842a71b30001 000000000980 01028051 00000000 00000000 01482108 59c5e95f 33010001 feffff00 00000000 00000000 00000000 00000000 00000000 00000000 00000000 // Request 534d4100000402a00000000100260010 606509a0 7a01842a71b30001 7d0042be283a0001 000000000a80 00028051 00644100 ff644100 00000000 => query grid relay status // Response 534d4100000402a000000001004e0010 606513a0 7d0042be283a00a1 7a01842a71b30001 000000000a80 01028051 07000000 07000000 01644108 59c5e95f 33000001 37010000 fdffff00 feffff00 00000000 00000000 00000000 00000000 00000000 -} -bool SpeedwireInverter::initialize() -{ - return m_interface->initialize(); -} - -bool SpeedwireInverter::initialized() const -{ - return m_interface->initialized(); -} - -void SpeedwireInverter::sendLoginRequest(const QString &password, bool loginAsUser) -{ - // Request 534d4100000402a000000001003a0010 60650ea0 7a01842a71b30001 7d0042be283a0001 000000000280 0c04fdff 07000000 84030000 00d8e85f 00000000 c1c1c1c18888888888888888 00000000 => login command = 0xfffd040c, first = 0x00000007 (user 7, installer a), last = 0x00000384 (hier timeout), time = 0x5fdf9ae8, 0x00000000, pw 12 bytes - - // Response 534d4100000402a000000001002e0010 60650be0 7d0042be283a0001 7a01842a71b30001 000000000280 0d04fdff 07000000 84030000 00d8e85f 00000000 00000000 => login OK - // Response 534d4100000402a000000001002e0010 60650be0 7d0042be283a0001 7a01842a71b30001 000100000280 0d04fdff 07000000 84030000 fddbe85f 00000000 00000000 => login INVALID PASSWORD - // command 0xfffd040c => 0x400 set? 0x00c bytecount=12? // Build the header - QByteArray header = QByteArray::fromHex("534d4100000402a000000001003a001060650ea0"); + QByteArray datagram; + QDataStream stream(&datagram, QIODevice::WriteOnly); + buildDefaultHeader(stream); - // The payload is little endian encoded - QByteArray payload; - QDataStream payloadStream(&payload, QIODevice::WriteOnly); - payloadStream.setByteOrder(QDataStream::LittleEndian); - - // Destination - payloadStream << m_modelId << m_serialNumber << static_cast(0x0100); - - // Source - payloadStream << m_interface->sourceModelId() << m_interface->sourceSerialNumber() << static_cast(0x0100); - - // Packet information - quint16 errorCode = 0; - quint16 fragmentId = 0; + // Reset the packet id counter, otherwise there will be no response quint16 packetId = m_packetId++ | 0x8000; - payloadStream << errorCode << fragmentId << packetId; - - // Command - payloadStream << static_cast(CommandQueryLogin); - - // User type: 7 = user, a = installer - payloadStream << (loginAsUser ? static_cast(0x00000007) : static_cast(0x0000000a)); - - // Timeout - payloadStream << static_cast(900); // 1s - - // Current time - payloadStream << static_cast(QDateTime::currentMSecsSinceEpoch() / 1000.0); - - // Zeros - payloadStream << static_cast(0); - - // Password - QByteArray passwordData = password.toUtf8(); - QByteArray encodedPassword(12, loginAsUser ? 0x88 : 0xBB); - for (int i = 0; i < password.count(); i++) { - encodedPassword[i] = passwordData.at(i) + (loginAsUser ? 0x88 : 0xBB); - } - - for (int i = 0; i < encodedPassword.count(); i++) { - payloadStream << static_cast(encodedPassword.at(i)); - } - - // End of data - payloadStream << static_cast(0); - - QByteArray data = header + payload; - qCDebug(dcSma()) << "Inverter: Send login request" << data.toHex(); - m_interface->sendData(data); - - // 534d4100000402a000000001003a001060650ea0 7a01 842a71b3 0001 7d00 42be283a 0001 000000000280 0c04fdff 07000000 84030000 00d8e85f 00000000 c1c1c1c18888888888888888 00000000 => login command = 0xfffd040c, first = 0x00000007 (user 7, installer a), last = 0x00000384 (hier timeout), time = 0x5fdf9ae8, 0x00000000, pw 12 bytes - // 534d4100000402a000000001003a001060650ea0 9013 be52007d 0001 7d00 42be283a 0001 000000000280 0c04fdff 07000000 84030000 cc96b061 00000000 c1c1c1c18888888888888888 00000000 - // 534d4100000402a000000001003a001060650ea0 9013 be52007d 0001 7d00 42be283a 0001 000000000180 0c04fdff 07000000 84030000 ae9db061 00000000 c1c1c1c18888888888888888 00000000 - -} - -void SpeedwireInverter::querySoftwareVersion() -{ - // Request 534d4100000402a00000000100260010 606509a0 7a01 842a71b30001 7d00 42be283a0001 000000000380 00020058 00348200 ff348200 00000000 => query software version - // Response 534d4100000402a000000001004e0010 606513a0 7d00 42be283a00a1 7a01 842a71b30001 000000000380 01020058 0a000000 0a000000 01348200 2ae5e65f 00000000 00000000 feffffff feffffff 040a1003 040a1003 00000000 00000000 00000000 code = 0x00823401 3 (BCD).10 (BCD).10 (BIN) Typ R (Enum) - - // ========= header - - // == 534d4100000402a00000000100260010 - - // 534d4100 : SMA\0 signature - // 0004 : header length - // 02a0 : Tag0 type - // 0000 : Tag version - // 0001 : Group - // 0026 : payload length - // 0010 : SMA Net 2 version - - // == 606509a0 - - // 6065 : inverter protocol id - // 09 : length of long words = payload length / 4 - // a0 : control ? - - - - // ========= payload (big endian) - - // == 7a01842a71b30001 - - // 7a01 : destination model id - // 842a71b3 : destination serial number - // 0001 : destination control field - - // == 7d0042be283a0001 - - // 7d00 : source model id - // 42be283a: source serial number - // 0001 : source control field - - // == 0000 0000 0380 00020058 - - // 0000 : error code - // 0000 : fragment id - // 0380 : packet id - - // 00020058 : command id = CommandQueryDevice - // 00348200 : first register - // ff348200 : last register - - // 00000000 : end of data - - qCDebug(dcSma()) << "Inverter: Query software version..."; // The payload is little endian encoded - QByteArray payload; - QDataStream payloadStream(&payload, QIODevice::WriteOnly); - payloadStream.setByteOrder(QDataStream::LittleEndian); + buildPackage(stream, command, packetId); - // Destination - payloadStream << m_modelId << m_serialNumber << static_cast(0x1000); - - // Source - payloadStream << m_interface->sourceModelId() << m_interface->sourceSerialNumber() << static_cast(0x1000); - - // Packet information - quint16 errorCode = 0; - quint16 fragmentId = 0; - m_packetId += 1; - quint16 packetId = m_packetId | 0x8000; - payloadStream << errorCode << fragmentId << packetId; - - // Request information - payloadStream << static_cast(CommandQueryDevice); - payloadStream << static_cast(0x00823400); // Software version first - payloadStream << static_cast(0x008234ff); // Software version last + // First and second word + stream << firstWord; + stream << secondWord; // End of data - payloadStream << static_cast(0); + stream << static_cast(0); - // Build the header - QByteArray header = QByteArray::fromHex("534d4100000402a00000000100260010606509a0"); - - QByteArray data = header + payload; - m_interface->sendData(data); + // Final datagram + SpeedwireInverterRequest request; + request.setPacketId(packetId); + request.setCommand(command); + request.setRequestData(datagram); + return createReply(request); } -void SpeedwireInverter::queryDeviceType() +void SpeedwireInverter::processSoftwareVersionResponse(const QByteArray &response) { - // Request 534d4100000402a00000000100260010 606509a0 7a01842a71b30001 7d0042be283a0001 000000000480 00020058 001e8200 ff208200 00000000 => query device type - // Response 534d4100000402a000000001009e0010 606527a0 7d0042be283a00a1 7a01842a71b30001 000000000480 01020058 01000000 03000000 011e8210 6f89e95f 534e3a20 33303130 35333831 31360000 00000000 00000000 00000000 00000000 - // 011f8208 6f89e95f 411f0001 feffff00 00000000 00000000 00000000 00000000 00000000 00000000 => 1f41 solar inverter - // 01208208 6f89e95f 96240000 80240000 81240001 82240000 feffff00 00000000 00000000 00000000 00000000 + // 07000000 07000000 01348200 2ff5b261 00000000 00000000 feffffff feffffff 00055302 00055302 00000000 00000000 00000000 + qCDebug(dcSma()) << "Inverter: Process software version request response" << response.toHex(); + // TODO: +// QDataStream stream(response); +// stream.setByteOrder(QDataStream::LittleEndian); + +// // First +// quint32 firstWord; +// quint32 secondWord; +// stream >> firstWord >> secondWord; +// quint8 byte1, byte2, byte3, byte4; +// stream >> byte1 >> byte2 >> byte3 >> byte4; + + // BCD + // 00 82 34 01 ?? +// QString softwareVersion = QString("%1.%2.%3.%4").arg(byte1).arg(byte2).arg(byte3).arg(byte4); +// qCDebug(dcSma()) << "Inverter: Software version" << softwareVersion; + } +void SpeedwireInverter::processDeviceTypeResponse(const QByteArray &response) +{ + // Request 534d4100000402a00000000100260010 606509a0 b500 c2c12e12 0001 7d00 43be283a 0001 0000 0000 0280 0002 0058 001e8200 ff208200 00000000 + // Response 534d4100000402a00000000100c60010 60653190 7d00 43be283a 00a1 b500 c2c12e12 0001 0000 0000 0280 0102 0058 00000000 03000000 + // 011e8210 85f2b661 534e3a20333035303534313436000000 feffff00 00000000 00000000 00000000 // SN: 305054146 + // 011f8208 85f2b661 411f 0001 421f 0000 feff ff00 0000 0000 0000 0000 0000 0000 0000 0000 0000 0000 // 411f -> 1f41 -> device type soar inverter + // 01208208 85f2b661 8a23 0000 8b23 0000 8c23 0001 8e23 0000 8f23 0000 e523 0000 e623 0000 e723 0000 // 238c -> 0001 -> STP 7000TL-20 + // 01208208 85f2b661 e923 0000 e823 0000 4124 0000 4224 0000 4324 0000 feff ff00 0000 0000 0000 0000 + // 00000000 + + // Response data: 00000000 03000000 -> first, last, then data + // 011e8210 3799b961 534e3a20 33303530 35343134 36000000 feffff00 00000000 00000000 00000000 // serialnumber as text + // 011f8208 3799b961 411f 0001 421f 0000 feff ff00 0000000000000000000000000000000000000000 // device class + // 01208208 3799b961 8a23 0000 8b23 0000 8c23 0001 8e23 0000 8f23 0000 e523 0000 e623 0000 e723 0000 // device model + // 01208208 3799b961 e923 0000 e823 0000 4124 0000 4224 0000 4324 0000 feff ff00 0000000000000000 // device model + // 00000000 // End of data + + + qCDebug(dcSma()) << "Inverter: Process device type response" << response.toHex(); + // TODO: + +} + +void SpeedwireInverter::processAcPowerResponse(const QByteArray &response) +{ + // Request 534d4100000402a00000000100260010606509a0 b500 c2c12e12 0001 7d00 52be283a 0001 0000 0000 0180 00020051 00404600 ff424600 00000000 + + // Response 534d4100000402a0000000010026001060650990 7d00 52be283a 00e1 b500 c2c12e12 0001 ffff 0000 0180 01020051 00404600 ff424600 00000000 // Error: login required + + // Response 534d4100000402a000000001007a001060651e90 7d00 52be283a 00a1 b500 c2c12e12 0001 0000 0000 0580 01020051 + // No sun + // 07000000 09000000 + // 01 4046 40 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 01 4146 40 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 01 4246 40 7503ba61 00000080 00000080 00000080 00000080 01000000 00000000 + + // Sun + // 07000000 09000000 + // 01 4046 40 77fbba61 23000000 23000000 23000000 23000000 01000000 + // 01 4146 40 77fbba61 23000000 23000000 23000000 23000000 01000000 + // 01 4246 40 77fbba61 23000000 23000000 23000000 23000000 01000000 + // 00000000 + + // 40464001 + qCDebug(dcSma()) << "Inverter: Process AC power query response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x464000 && measurmentNumber == 0x01) { + quint32 powerAcPhase1; + stream >> powerAcPhase1; + m_powerAcPhase1 = readValue(powerAcPhase1, 1000.0); + qCDebug(dcSma()) << "Inverter: Power AC phase 1" << m_powerAcPhase1 << "W"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x464100 && measurmentNumber == 0x01) { + quint32 powerAcPhase2; + stream >> powerAcPhase2; + m_powerAcPhase2 = readValue(powerAcPhase2, 1000.0); + qCDebug(dcSma()) << "Inverter: Power AC phase 2" << m_powerAcPhase2 << "W"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x464200 && measurmentNumber == 0x01) { + quint32 powerAcPhase3; + stream >> powerAcPhase3; + m_powerAcPhase3 = readValue(powerAcPhase3, 1000.0); + qCDebug(dcSma()) << "Inverter: Power AC phase 3" << m_powerAcPhase3 << "W"; + readUntilEndOfMeasurement(stream); + } + } +} + + +void SpeedwireInverter::processAcVoltageCurrentResponse(const QByteArray &response) +{ + // No sun + // 0a000000 0f000000 + // 01 4846 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 01 4946 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 01 4a46 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 01 5046 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 01 5146 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 01 5246 00 7503ba61 ffffffff ffffffff ffffffff ffffffff 01000000 + // 00000000 + + // Sun + // 0a000000 0f000000 + // 01484600 c1f0ba61 f9580000 f9580000 f9580000 f9580000 01000000 + // 01494600 c1f0ba61 ff580000 ff580000 ff580000 ff580000 01000000 + // 014a4600 c1f0ba61 02590000 02590000 02590000 02590000 01000000 + // 01504600 c1f0ba61 00000000 00000000 00000000 00000000 01000000 + // 01514600 c1f0ba61 00000000 00000000 00000000 00000000 01000000 + // 01524600 c1f0ba61 00000000 00000000 00000000 00000000 01000000 + // 00000000 + + qCDebug(dcSma()) << "Inverter: Process AC voltage/current query response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x464800 && measurmentNumber == 0x01) { + quint32 voltageAcPhase1; + stream >> voltageAcPhase1; + m_voltageAcPhase1 = readValue(voltageAcPhase1, 100.0); + qCDebug(dcSma()) << "Inverter: Voltage AC phase 1" << m_voltageAcPhase1 << "V"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x464900 && measurmentNumber == 0x01) { + quint32 voltageAcPhase2; + stream >> voltageAcPhase2; + m_voltageAcPhase2 = readValue(voltageAcPhase2, 100.0); + qCDebug(dcSma()) << "Inverter: Voltage AC phase 2" << m_voltageAcPhase2 << "V"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x464a00 && measurmentNumber == 0x01) { + quint32 voltageAcPhase3; + stream >> voltageAcPhase3; + m_voltageAcPhase3 = readValue(voltageAcPhase3, 100.0); + qCDebug(dcSma()) << "Inverter: Voltage AC phase 3" << m_voltageAcPhase3 << "V"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x465000 && measurmentNumber == 0x01) { + quint32 currentAcPhase1; + stream >> currentAcPhase1; + m_currentAcPhase1 = readValue(currentAcPhase1, 1000.0); + qCDebug(dcSma()) << "Inverter: Current AC phase 1" << m_currentAcPhase1 << "A"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x465100 && measurmentNumber == 0x01) { + quint32 currentAcPhase2; + stream >> currentAcPhase2; + m_currentAcPhase2 = readValue(currentAcPhase2, 1000.0); + qCDebug(dcSma()) << "Inverter: Current AC phase 2" << m_currentAcPhase2 << "A"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x465200 && measurmentNumber == 0x01) { + quint32 currentAcPhase3; + stream >> currentAcPhase3; + m_currentAcPhase3 = readValue(currentAcPhase3, 1000.0); + qCDebug(dcSma()) << "Inverter: Current AC phase 3" << m_currentAcPhase3 << "A"; + readUntilEndOfMeasurement(stream); + } + } +} + +void SpeedwireInverter::processAcTotalPowerResponse(const QByteArray &response) +{ + // 00000000 00000000 + // 013f2640 8606bb61 16010000 16010000 16010000 16010000 01000000 + // 00000000 + qCDebug(dcSma()) << "Inverter: Process AC total power query response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x263f00 && measurmentNumber == 0x01) { + quint32 totalAcPower; + stream >> totalAcPower; + m_totalAcPower = readValue(totalAcPower, 1000.0); + qCDebug(dcSma()) << "Inverter: Total AC power" << m_totalAcPower << "W"; + readUntilEndOfMeasurement(stream); + } + } +} + + +void SpeedwireInverter::processDcPowerResponse(const QByteArray &response) +{ + // No sun + // 00000000 01000000 + // 011e2540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 021e2540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 00000000 + + // Sun + // 00000000 01000000 + // 011e2540 7b0dbb61 8a000000 8a000000 8a000000 8a000000 01000000 + // 021e2540 7b0dbb61 8f000000 8f000000 8f000000 8f000000 01000000 + // 00000000 + qCDebug(dcSma()) << "Inverter: Process DC power query response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x251e00 && measurmentNumber == 0x01) { + quint32 powerMpp1; + stream >> powerMpp1; + m_powerDcMpp1 = readValue(powerMpp1, 1000.0); + qCDebug(dcSma()) << "Inverter: DC power MPP1" << m_powerDcMpp1 << "W"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x251e00 && measurmentNumber == 0x02) { + quint32 powerMpp2; + stream >> powerMpp2; + m_powerDcMpp2 = readValue(powerMpp2, 1000.0); + qCDebug(dcSma()) << "Inverter: DC power MPP2" << m_powerDcMpp2 << "W"; + readUntilEndOfMeasurement(stream); + } + } +} + +void SpeedwireInverter::processDcVoltageCurrentResponse(const QByteArray &response) +{ + // 02000000 05000000 + // 011f4540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 021f4540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 01214540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 02214540 7503ba61 00000080 00000080 00000080 00000080 01000000 + // 00000000 + + // 02000000 05000000 + // 011f4540 160ebb61 009a0000 009a0000 009a0000 009a0000 01000000 + // 021f4540 160ebb61 02a00000 02a00000 02a00000 02a00000 01000000 + // 01214540 160ebb61 76010000 76010000 76010000 76010000 01000000 + // 02214540 160ebb61 77010000 77010000 77010000 77010000 01000000 + // 00000000 + + qCDebug(dcSma()) << "Inverter: Process DC voltage/current response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x451f00 && measurmentNumber == 0x01) { + quint32 voltageMpp1; + stream >> voltageMpp1; + m_voltageDcMpp1 = readValue(voltageMpp1, 100.0); + qCDebug(dcSma()) << "Inverter: DC voltage MPP1" << m_voltageDcMpp1 << "V"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x451e00 && measurmentNumber == 0x02) { + quint32 voltageMpp2; + stream >> voltageMpp2; + m_voltageDcMpp2 = readValue(voltageMpp2, 100.0); + qCDebug(dcSma()) << "Inverter: DC voltage MPP2" << m_voltageDcMpp2 << "V"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x452100 && measurmentNumber == 0x01) { + quint32 currentMpp1; + stream >> currentMpp1; + m_currentDcMpp1 = readValue(currentMpp1, 1000.0); + qCDebug(dcSma()) << "Inverter: DC current MPP1" << m_currentDcMpp1 << "A"; + readUntilEndOfMeasurement(stream); + } else if (measurementId == 0x452100 && measurmentNumber == 0x02) { + quint32 currentMpp2; + stream >> currentMpp2; + m_currentDcMpp2 = readValue(currentMpp2, 1000.0); + qCDebug(dcSma()) << "Inverter: DC current MPP2" << m_currentDcMpp2 << "A"; + readUntilEndOfMeasurement(stream); + } + } +} + +void SpeedwireInverter::processEnergyProductionResponse(const QByteArray &response) +{ + // 00000000 01000000 + // 01012600 6f03ba61 4d147402 0000000 00122260 01523ba6 17c05000 00000000 + // 000000000 + + qCDebug(dcSma()) << "Inverter: Process energy production response";// << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + quint32 dataId, dataType; + stream >> dataId >> dataType; + + quint32 unknwonWord; + quint32 totalEnergy, todayEnergy; + stream >> totalEnergy >> unknwonWord >> unknwonWord >> unknwonWord >> todayEnergy; + + m_todayEnergyProduced = readValue(todayEnergy, 1000.0); + m_totalEnergyProduced = readValue(totalEnergy, 1000.0); + qCDebug(dcSma()) << "Inverter: Energy total:" << m_totalEnergyProduced << "kWh"; + qCDebug(dcSma()) << "Inverter: Energy today:" << m_todayEnergyProduced << "kWh"; +} + +void SpeedwireInverter::processGridFrequencyResponse(const QByteArray &response) +{ + // 10000000 10000000 + // 01574600 c20cbb61 89130000 89130000 89130000 89130000 010000000 + // 0000000 + qCDebug(dcSma()) << "Inverter: Process grid frequency response"; // << response.toHex(); + QDataStream stream(response); + stream.setByteOrder(QDataStream::LittleEndian); + quint32 firstWord, secondWord; + stream >> firstWord >> secondWord; + + // Each line has 7 words + quint32 measurementId; + quint32 measurementType; // ? + + while (!stream.atEnd()) { + // First row + stream >> measurementId; + + // End of data, we are done + if (measurementId == 0) + return; + + // Unknown + stream >> measurementType; + + quint8 measurmentNumber = static_cast(measurementId & 0xff); + measurementId = measurementId & 0x00ffff00; + + // Read measurent lines + if (measurementId == 0x465700 && measurmentNumber == 0x01) { + quint32 frequency; + stream >> frequency; + m_gridFrequency = readValue(frequency, 100.0); + qCDebug(dcSma()) << "Inverter: Grid frequency" << m_gridFrequency << "Hz"; + readUntilEndOfMeasurement(stream); + } + } +} + +void SpeedwireInverter::processInverterStatusResponse(const QByteArray &response) +{ + // 00000000 00000000 + // 01482108 b527bb61 23000000 2f010000 33010001 c7010000 feffff00 00000000 00000000 00000000 + // 00000000 + qCDebug(dcSma()) << "Inverter: Process inverter status response" << response.toHex(); + // TODO: +} + +void SpeedwireInverter::readUntilEndOfMeasurement(QDataStream &stream) +{ + // Read until end of line (0x01000000) + quint32 word; + while (!stream.atEnd()) { + stream >> word; + if (word == 1) { + return; + } + } +} + +double SpeedwireInverter::readValue(quint32 value, double divisor) +{ + if (value == 0x80000000 || value == 0xffffffff) + return 0; + + return value / divisor; +} + +void SpeedwireInverter::setReachable(bool reachable) +{ + if (m_reachable == reachable) + return; + + m_reachable = reachable; + emit reachableChanged(m_reachable); +} void SpeedwireInverter::processData(const QByteArray &data) { - qCDebug(dcSma()) << "Inverter: data received" << data.toHex(); + if (data.size() < 18) { + qCDebug(dcSma()) << "Inverter: The received datagram is to short to be a SMA speedwire message. Ignoring data..."; + return; + } + QDataStream stream(data); + Speedwire::Header header = Speedwire::parseHeader(stream); + if (!header.isValid()) { + qCWarning(dcSma()) << "Inverter: Datagram header is not valid. Ignoring data..."; + return; + } + + if (header.protocolId != Speedwire::ProtocolIdInverter) { + qCWarning(dcSma()) << "Inverter: Received datagram from different protocol" << header.protocolId << "Ignoring data..."; + return; + } + + Speedwire::InverterPackage package = Speedwire::parseInverterPackage(stream); + if (package.sourceModelId != m_modelId || package.sourceSerialNumber != m_serialNumber) { + qCWarning(dcSma()) << "Inverter: Received datagram from different inverter" << package.sourceSerialNumber << "Ignoring data..."; + return; + } + + qCDebug(dcSma()) << "Inverter: <-- Received" << static_cast(package.command) << "Packet ID:" << package.packetId; + //qCDebug(dcSma()) << "Inverter:" << data.toHex(); + if (m_currentReply && m_currentReply->request().packetId() == package.packetId) { + qCDebug(dcSma()) << "Inverter: Received response for current reply" << static_cast(m_currentReply->request().command()) << "Packet ID:" << m_currentReply->request().packetId(); + m_currentReply->m_responseData = data; + m_currentReply->m_responseHeader = header; + m_currentReply->m_responsePackage = package; + // Set the payload + while (!stream.atEnd()) { + quint8 byte; + stream >> byte; + m_currentReply->m_responsePayload.append(byte); + } + + if (package.errorCode != 0) { + m_currentReply->finishReply(SpeedwireInverterReply::ErrorInverterError); + } else { + m_currentReply->finishReply(SpeedwireInverterReply::ErrorNoError); + } + } else { + if (m_currentReply) { + qCWarning(dcSma()) << "Inverter: Received unexpected data: waiting for" << static_cast(m_currentReply->request().command()) << "Packet ID:" << m_currentReply->request().packetId(); + } else { + qCWarning(dcSma()) << "Inverter: Received unexpected data: not waiting for any response."; + } + qCWarning(dcSma()) << "Inverter:" << header; + qCWarning(dcSma()) << "Inverter:" << package; + qCWarning(dcSma()) << "Inverter:" << data.toHex(); + } +} + +void SpeedwireInverter::onReplyTimeout() +{ + SpeedwireInverterReply *reply = qobject_cast(sender()); + qCDebug(dcSma()) << "Inverter: Reply timeout" << reply->request().packetId() << reply->request().command(); + reply->m_retries += 1; + if (reply->m_retries <= reply->m_maxRetries) { + qCDebug(dcSma()) << "Inverter: Resend request" << reply->m_retries << "/" << reply->m_maxRetries; + m_replyQueue.prepend(reply); + m_currentReply = nullptr; + sendNextReply(); + } else { + if (reply->m_maxRetries == 0) { + qCWarning(dcSma()) << "Inverter: No response received for request. Finish reply with" << SpeedwireInverterReply::ErrorTimeout; + } else { + qCWarning(dcSma()) << "Inverter: No response received for request after" << reply->m_maxRetries << "attempts. Finish reply with" << SpeedwireInverterReply::ErrorTimeout; + } + // Finish with timeout error + reply->finishReply(SpeedwireInverterReply::ErrorTimeout); + } +} + +void SpeedwireInverter::onReplyFinished() +{ + SpeedwireInverterReply *reply = qobject_cast(sender()); + if (m_currentReply == reply) { + // Note: the reply is self deleting on finished + m_currentReply = nullptr; + sendNextReply(); + } +} + +void SpeedwireInverter::setState(State state) +{ + if (m_state == state) + return; + + qCDebug(dcSma()) << "Inverter: State changed" << state; + m_state = state; + emit stateChanged(m_state); + + switch (m_state) { + case StateIdle: + break; + case StateDisconnected: + setReachable(false); + break; + case StateInitializing: { + // Try to fetch ac power + qCDebug(dcSma()) << "Inverter: Request AC power..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryAc, 0x00464000, 0x004642ff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + if (reply->error() == SpeedwireInverterReply::ErrorTimeout) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + if (reply->error() == SpeedwireInverterReply::ErrorInverterError) { + qCDebug(dcSma()) << "Inverter: Query data request finished with inverter error. Try to login..."; + setState(StateLogin); + return; + } + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processAcPowerResponse(reply->responseData()); + + if (deviceInformationFetched) { + setState(StateQueryData); + } else { + setState(StateGetInformation); + } + }); + break; + } + + case StateLogin: { + setState(StateLogin); + SpeedwireInverterReply *loginReply = sendLoginRequest(); + connect(loginReply, &SpeedwireInverterReply::finished, this, [=](){ + if (loginReply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to login to inverter:" << loginReply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Login request finished successfully."; + setReachable(true); + + // Logged in successfully, reinit the data fetch process + setState(StateInitializing); + }); + break; + } + case StateGetInformation: { + SpeedwireInverterReply *softwareVersionReply = sendSoftwareVersionRequest(); + connect(softwareVersionReply, &SpeedwireInverterReply::finished, this, [=](){ + if (softwareVersionReply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to get software version from inverter:" << softwareVersionReply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Software version request finished successfully."; + processSoftwareVersionResponse(softwareVersionReply->responsePayload()); + + SpeedwireInverterReply *deviceTypeReply = sendDeviceTypeRequest(); + connect(deviceTypeReply, &SpeedwireInverterReply::finished, this, [=](){ + if (deviceTypeReply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to get device information from inverter:" << deviceTypeReply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Get device information finished successfully."; + processDeviceTypeResponse(deviceTypeReply->responsePayload()); + deviceInformationFetched = true; + setState(StateQueryData); + }); + }); + break; + } + case StateQueryData: { + // Query inverter status + qCDebug(dcSma()) << "Inverter: Request inverter status..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryStatus, 0x00214800, 0x002148FF); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to get status from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Get inverter status request finished successfully" << reply->request().command(); + processInverterStatusResponse(reply->responsePayload()); + + // Query AC voltage / current + qCDebug(dcSma()) << "Inverter: Request AC voltage and current..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryAc, 0x00464800, 0x004655ff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processAcVoltageCurrentResponse(reply->responsePayload()); + + // Query DC power + qCDebug(dcSma()) << "Inverter: Request DC power..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryDc, 0x00251e00, 0x00251eff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processDcPowerResponse(reply->responsePayload()); + + // Query DC voltage/current + qCDebug(dcSma()) << "Inverter: Request DC voltage and current..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryDc, 0x00451f00, 0x004521ff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processDcVoltageCurrentResponse(reply->responsePayload()); + + // Query energy production + qCDebug(dcSma()) << "Inverter: Request energy production..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryEnergy, 0x00260100, 0x002622ff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processEnergyProductionResponse(reply->responsePayload()); + + // Query total AC power + qCDebug(dcSma()) << "Inverter: Request total AC power..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryAc, 0x00263f00, 0x00263fff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processAcTotalPowerResponse(reply->responsePayload()); + + // Query grid frequency + qCDebug(dcSma()) << "Inverter: Request grid frequency..."; + SpeedwireInverterReply *reply = sendQueryRequest(Speedwire::CommandQueryAc, 0x00465700, 0x004657ff); + connect(reply, &SpeedwireInverterReply::finished, this, [=](){ + if (reply->error() != SpeedwireInverterReply::ErrorNoError) { + qCWarning(dcSma()) << "Inverter: Failed to query data from inverter:" << reply->request().command() << reply->error(); + setState(StateDisconnected); + return; + } + + qCDebug(dcSma()) << "Inverter: Query request finished successfully" << reply->request().command(); + processGridFrequencyResponse(reply->responsePayload()); + + setReachable(true); + emit valuesUpdated(); + setState(StateIdle); + }); + }); + }); + }); + }); + }); + }); + break; + } + } } diff --git a/sma/speedwireinverter.h b/sma/speedwireinverter.h index 2d1c3ee5..518baf07 100644 --- a/sma/speedwireinverter.h +++ b/sma/speedwireinverter.h @@ -1,56 +1,114 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #ifndef SPEEDWIREINVERTER_H #define SPEEDWIREINVERTER_H #include +#include +#include "speedwire.h" #include "speedwireinterface.h" +#include "speedwireinverterreply.h" +#include "speedwireinverterrequest.h" class SpeedwireInverter : public QObject { Q_OBJECT public: - enum Command { - CommandQueryAc = 0x51000200, - CommandQueryStatus = 0x51800200, - CommandQueryDevice = 0x58000200, - CommandQueryDc = 0x53800200, - CommandQueryLogin = 0xfffd040c + enum State { + StateIdle, + StateDisconnected, + StateInitializing, + StateLogin, + StateGetInformation, + StateQueryData }; - - - Q_ENUM(Command) - - - class Request - { - public: - Request(); - - SpeedwireInverter::Command command() const; - - quint16 requestId() const; - - private: - SpeedwireInverter::Command m_command; - quint16 m_requestId = 0; - - }; - + Q_ENUM(State) explicit SpeedwireInverter(const QHostAddress &address, quint16 modelId, quint32 serialNumber, QObject *parent = nullptr); bool initialize(); bool initialized() const; - double currentPower() const; + State state() const; + + bool reachable() const; + + Speedwire::DeviceClass deviceClass() const; + QString modelName() const; + + double totalAcPower() const; + + double gridFrequency() const; + double totalEnergyProduced() const; + double todayEnergyProduced() const; + + double voltageAcPhase1() const; + double voltageAcPhase2() const; + double voltageAcPhase3() const; + + double currentAcPhase1() const; + double currentAcPhase2() const; + double currentAcPhase3() const; + + double powerAcPhase1() const; + double powerAcPhase2() const; + double powerAcPhase3() const; + + double powerDcMpp1() const; + double powerDcMpp2() const; + + double voltageDcMpp1() const; + double voltageDcMpp2() const; + + double currentDcMpp1() const; + double currentDcMpp2() const; // Query methods - void sendLoginRequest(const QString &password = "0000", bool loginAsUser = true); - void querySoftwareVersion(); - void queryDeviceType(); + SpeedwireInverterReply *sendIdentifyRequest(); + SpeedwireInverterReply *sendLoginRequest(const QString &password = "0000", bool loginAsUser = true); + SpeedwireInverterReply *sendLogoutRequest(); + SpeedwireInverterReply *sendSoftwareVersionRequest(); + SpeedwireInverterReply *sendDeviceTypeRequest(); + + // Start connecting + void startConnecting(); + +public slots: + void refresh(); signals: + void reachableChanged(bool reachable); + void stateChanged(State state); void valuesUpdated(); private: @@ -59,17 +117,83 @@ private: bool m_initialized = false; quint16 m_modelId = 0; quint32 m_serialNumber = 0; - quint16 m_packetId = 0; + + bool m_reachable = false; + State m_state = StateDisconnected; + quint16 m_packetId = 1; + + bool deviceInformationFetched = false; + + SpeedwireInverterReply *m_currentReply = nullptr; + QQueue m_replyQueue; // Properties - double m_currentPower = 0; - double m_totalEnergyProduced = 0; - + Speedwire::DeviceClass m_deviceClass = Speedwire::DeviceClassUnknown; + QString m_modelName; QString m_softwareVersion; + double m_totalAcPower = 0; + double m_totalEnergyProduced = 0; + double m_todayEnergyProduced = 0; + + double m_gridFrequency = 0; + + double m_voltageAcPhase1 = 0; + double m_voltageAcPhase2 = 0; + double m_voltageAcPhase3 = 0; + + double m_currentAcPhase1 = 0; + double m_currentAcPhase2 = 0; + double m_currentAcPhase3 = 0; + + double m_powerAcPhase1 = 0; + double m_powerAcPhase2 = 0; + double m_powerAcPhase3 = 0; + + double m_powerDcMpp1 = 0; + double m_powerDcMpp2 = 0; + + double m_voltageDcMpp1 = 0; + double m_voltageDcMpp2 = 0; + + double m_currentDcMpp1 = 0; + double m_currentDcMpp2 = 0; + + void setState(State state); + + void sendNextReply(); + SpeedwireInverterReply *createReply(const SpeedwireInverterRequest &request); + + // Request builder function + void buildDefaultHeader(QDataStream &stream, quint16 payloadSize = 38, quint8 control = 0xa0); + void buildPackage(QDataStream &stream, quint32 command, quint16 packetId); + + // Send generic request for internal use + SpeedwireInverterReply *sendQueryRequest(Speedwire::Command command, quint32 firstWord, quint32 secondWord); + + // Response process methods + void processSoftwareVersionResponse(const QByteArray &response); + void processDeviceTypeResponse(const QByteArray &response); + void processAcPowerResponse(const QByteArray &response); + void processAcVoltageCurrentResponse(const QByteArray &response); + void processAcTotalPowerResponse(const QByteArray &response); + void processDcPowerResponse(const QByteArray &response); + void processDcVoltageCurrentResponse(const QByteArray &response); + void processEnergyProductionResponse(const QByteArray &response); + void processGridFrequencyResponse(const QByteArray &response); + void processInverterStatusResponse(const QByteArray &response); + + void readUntilEndOfMeasurement(QDataStream &stream); + double readValue(quint32 value, double divisor); + + void setReachable(bool reachable); + private slots: void processData(const QByteArray &data); + void onReplyTimeout(); + void onReplyFinished(); + }; #endif // SPEEDWIREINVERTER_H diff --git a/sma/speedwireinverterreply.cpp b/sma/speedwireinverterreply.cpp new file mode 100644 index 00000000..e65e0f50 --- /dev/null +++ b/sma/speedwireinverterreply.cpp @@ -0,0 +1,85 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + +#include "speedwireinverterreply.h" +#include "extern-plugininfo.h" + +SpeedwireInverterReply::SpeedwireInverterReply(const SpeedwireInverterRequest &request, QObject *parent) : + QObject(parent), + m_request(request) +{ + m_maxRetries = m_request.retries(); + + m_timer.setInterval(m_timeout); + m_timer.setSingleShot(true); + connect(&m_timer, &QTimer::timeout, this, &SpeedwireInverterReply::timeout); +} + +SpeedwireInverterRequest SpeedwireInverterReply::request() const +{ + return m_request; +} + +SpeedwireInverterReply::Error SpeedwireInverterReply::error() const +{ + return m_error; +} + +QByteArray SpeedwireInverterReply::responseData() const +{ + return m_responseData; +} + +Speedwire::Header SpeedwireInverterReply::responseHeader() const +{ + return m_responseHeader; +} + +Speedwire::InverterPackage SpeedwireInverterReply::responsePackage() const +{ + return m_responsePackage; +} + +QByteArray SpeedwireInverterReply::responsePayload() const +{ + return m_responsePayload; +} + +void SpeedwireInverterReply::startWaiting() +{ + m_timer.start(); +} + +void SpeedwireInverterReply::finishReply(Error error) +{ + m_timer.stop(); + m_error = error; + emit finished(); +} diff --git a/sma/speedwireinverterreply.h b/sma/speedwireinverterreply.h new file mode 100644 index 00000000..f2f8078f --- /dev/null +++ b/sma/speedwireinverterreply.h @@ -0,0 +1,89 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + +#ifndef SPEEDWIREINVERTERREPLY_H +#define SPEEDWIREINVERTERREPLY_H + +#include +#include + +#include "speedwireinverterrequest.h" + +class SpeedwireInverterReply : public QObject +{ + Q_OBJECT + + friend class SpeedwireInverter; + +public: + enum Error { + ErrorNoError, // Response on, no error + ErrorInverterError, // Inverter returned error + ErrorTimeout // Request timeouted + }; + Q_ENUM(Error) + + // Request + SpeedwireInverterRequest request() const; + + Error error() const; + + // Response + QByteArray responseData() const; + Speedwire::Header responseHeader() const; + Speedwire::InverterPackage responsePackage() const; + QByteArray responsePayload() const; + +signals: + void finished(); + void timeout(); + +private: + explicit SpeedwireInverterReply(const SpeedwireInverterRequest &request, QObject *parent = nullptr); + + QTimer m_timer; + Error m_error = ErrorNoError; + SpeedwireInverterRequest m_request; + quint8 m_retries = 0; + quint8 m_maxRetries = 3; + int m_timeout = 3000; + + QByteArray m_responseData; + Speedwire::Header m_responseHeader; + Speedwire::InverterPackage m_responsePackage; + QByteArray m_responsePayload; + + + void finishReply(Error error); + void startWaiting(); + +}; + +#endif // SPEEDWIREINVERTERREPLY_H diff --git a/sma/speedwireinverterrequest.cpp b/sma/speedwireinverterrequest.cpp new file mode 100644 index 00000000..fd1befb8 --- /dev/null +++ b/sma/speedwireinverterrequest.cpp @@ -0,0 +1,76 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + +#include "speedwireinverterrequest.h" + +SpeedwireInverterRequest::SpeedwireInverterRequest() +{ + +} + +Speedwire::Command SpeedwireInverterRequest::command() const +{ + return m_command; +} + +void SpeedwireInverterRequest::setCommand(Speedwire::Command command) +{ + m_command = command; +} + +quint16 SpeedwireInverterRequest::packetId() const +{ + return m_packetId; +} + +void SpeedwireInverterRequest::setPacketId(quint16 packetId) +{ + m_packetId = packetId; +} + +QByteArray SpeedwireInverterRequest::requestData() const +{ + return m_requestData; +} + +void SpeedwireInverterRequest::setRequestData(const QByteArray &requestData) +{ + m_requestData = requestData; +} + +quint8 SpeedwireInverterRequest::retries() const +{ + return m_retries; +} + +void SpeedwireInverterRequest::setRetries(quint8 retries) +{ + m_retries = retries; +} diff --git a/sma/speedwireinverterrequest.h b/sma/speedwireinverterrequest.h new file mode 100644 index 00000000..bd6cb22a --- /dev/null +++ b/sma/speedwireinverterrequest.h @@ -0,0 +1,62 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + +#ifndef SPEEDWIREINVERTERREQUEST_H +#define SPEEDWIREINVERTERREQUEST_H + +#include + +#include "speedwire.h" + +class SpeedwireInverterRequest +{ +public: + explicit SpeedwireInverterRequest(); + + Speedwire::Command command() const; + void setCommand(Speedwire::Command command); + + quint16 packetId() const; + void setPacketId(quint16 packetId); + + QByteArray requestData() const; + void setRequestData(const QByteArray &requestData); + + quint8 retries() const; + void setRetries(quint8 retries); + +private: + Speedwire::Command m_command; + quint16 m_packetId = 0; + QByteArray m_requestData; + quint8 m_retries = 2; // Default try 2 times before timeout +}; + +#endif // SPEEDWIREINVERTERREQUEST_H diff --git a/sma/speedwiremeter.cpp b/sma/speedwiremeter.cpp index b460bd63..152ae871 100644 --- a/sma/speedwiremeter.cpp +++ b/sma/speedwiremeter.cpp @@ -1,3 +1,33 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #include "speedwiremeter.h" #include "extern-plugininfo.h" @@ -9,11 +39,20 @@ SpeedwireMeter::SpeedwireMeter(const QHostAddress &address, quint16 modelId, qui { m_interface = new SpeedwireInterface(m_address, true, this); connect(m_interface, &SpeedwireInterface::dataReceived, this, &SpeedwireMeter::processData); + + // Reachable timestamp + m_timer.setInterval(5000); + m_timer.setSingleShot(false); + connect(&m_timer, &QTimer::timeout, this, &SpeedwireMeter::evaluateReachable); } bool SpeedwireMeter::initialize() { - return m_interface->initialize(); + bool initSuccess = m_interface->initialize(); + if (initSuccess) + m_timer.start(); + + return initSuccess; } bool SpeedwireMeter::initialized() const @@ -21,6 +60,11 @@ bool SpeedwireMeter::initialized() const return m_interface->initialized(); } +bool SpeedwireMeter::reachable() const +{ + return m_reachable; +} + double SpeedwireMeter::currentPower() const { return m_currentPower; @@ -116,19 +160,45 @@ QString SpeedwireMeter::softwareVersion() const return m_softwareVersion; } +void SpeedwireMeter::evaluateReachable() +{ + // Note: the meter sends every second the data on the multicast + qint64 currentTimestamp = QDateTime::currentDateTime().toMSecsSinceEpoch() / 1000; + // If the meter has not sent data within the last 5 seconds it seems not to be reachable + bool reachable = false; + if (currentTimestamp - m_lastSeenTimestamp < 10) { + reachable = true; + } + + if (m_reachable != reachable) { + qCDebug(dcSma()) << "Meter: reachable changed to" << reachable; + m_reachable = reachable; + emit reachableChanged(m_reachable); + } + + // Restart the timer + if (m_reachable) { + m_timer.start(); + } else { + // Reachable will be triggered automatically once data arrives + // No need to run the timer all the time + m_timer.stop(); + } +} + void SpeedwireMeter::processData(const QByteArray &data) { qCDebug(dcSma()) << "Meter: data received" << data.toHex(); QDataStream stream(data); stream.setByteOrder(QDataStream::BigEndian); - SpeedwireInterface::SpeedwireHeader header = SpeedwireInterface::parseHeader(stream); + Speedwire::Header header = Speedwire::parseHeader(stream); if (!header.isValid()) { qCDebug(dcSma()) << "Meter: Datagram header is not valid. Ignoring data..."; return; } - if (header.protocolId != SpeedwireInterface::ProtocolIdMeter) { + if (header.protocolId != Speedwire::ProtocolIdMeter) { qCDebug(dcSma()) << "Meter: received header protocol which is not from the meter protocol. Ignoring data..."; return; } @@ -266,5 +336,9 @@ void SpeedwireMeter::processData(const QByteArray &data) } } + // Save the current timestamp for reachable evaluation + m_lastSeenTimestamp = QDateTime::currentDateTime().toMSecsSinceEpoch() / 1000; + evaluateReachable(); + emit valuesUpdated(); } diff --git a/sma/speedwiremeter.h b/sma/speedwiremeter.h index 82f251c9..0599cf3b 100644 --- a/sma/speedwiremeter.h +++ b/sma/speedwiremeter.h @@ -1,7 +1,39 @@ +/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * +* +* Copyright 2013 - 2021, nymea GmbH +* Contact: contact@nymea.io +* +* This file is part of nymea. +* This project including source code and documentation is protected by +* copyright law, and remains the property of nymea GmbH. All rights, including +* reproduction, publication, editing and translation, are reserved. The use of +* this project is subject to the terms of a license agreement to be concluded +* with nymea GmbH in accordance with the terms of use of nymea GmbH, available +* under https://nymea.io/license +* +* GNU Lesser General Public License Usage +* Alternatively, this project may be redistributed and/or modified under the +* terms of the GNU Lesser General Public License as published by the Free +* Software Foundation; version 3. This project is distributed in the hope that +* it will be useful, but WITHOUT ANY WARRANTY; without even the implied +* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +* Lesser General Public License for more details. +* +* You should have received a copy of the GNU Lesser General Public License +* along with this project. If not, see . +* +* For any further details and any questions please contact us under +* contact@nymea.io or see our FAQ/Licensing Information on +* https://nymea.io/license/faq +* +* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ + #ifndef SPEEDWIREMETER_H #define SPEEDWIREMETER_H #include +#include +#include #include "speedwireinterface.h" @@ -14,6 +46,8 @@ public: bool initialize(); bool initialized() const; + bool reachable() const; + double currentPower() const; double totalEnergyProduced() const; double totalEnergyConsumed() const; @@ -42,6 +76,7 @@ public: signals: + void reachableChanged(bool reachable); void valuesUpdated(); private: @@ -51,6 +86,10 @@ private: quint16 m_modelId = 0; quint32 m_serialNumber = 0; + QTimer m_timer; + bool m_reachable = false; + qint64 m_lastSeenTimestamp = 0; + double m_currentPower = 0; double m_totalEnergyProduced = 0; double m_totalEnergyConsumed = 0; @@ -77,7 +116,9 @@ private: QString m_softwareVersion; + private slots: + void evaluateReachable(); void processData(const QByteArray &data); };