Diff: CommandTerminal/CmdTxFrequency.cpp

Revision:

0:3c869a8cb8f8

diff -r 000000000000 -r 3c869a8cb8f8 CommandTerminal/CmdTxFrequency.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CommandTerminal/CmdTxFrequency.cpp	Thu Oct 18 04:18:48 2018 +0000
@@ -0,0 +1,57 @@
+#include "CmdTxFrequency.h"
+#include <climits>
+
+
+CmdTxFrequency::CmdTxFrequency() :
+    Command("Tx Frequency", "AT+TXF", "Set Tx frequency", "SEE PLAN") {
+    _queryable = true;
+}
+
+uint32_t CmdTxFrequency::action(std::vector<std::string> args)
+{
+    if (args.size() == 1)
+    {
+        CommandTerminal::Serial()->writef("%lu\r\n", CommandTerminal::Dot()->getTxFrequency());
+    }
+    else if (args.size() == 2)
+    {
+        int frequency = 0;
+
+        sscanf(args[1].c_str(), "%d", &frequency);
+        if (CommandTerminal::Dot()->setTxFrequency(frequency) != mDot::MDOT_OK)
+        {
+            CommandTerminal::setErrorMessage(CommandTerminal::Dot()->getLastError());;
+            return 1;
+        }
+    }
+
+    return 0;
+}
+
+bool CmdTxFrequency::verify(std::vector<std::string> args)
+{
+    if (args.size() == 1)
+        return true;
+
+    if (args.size() == 2)
+    {
+        int frequency = ULONG_MAX;
+        if (sscanf(args[1].c_str(), "%d", &frequency) != 1) {
+            CommandTerminal::setErrorMessage("Invalid argument");
+            return false;
+        }
+
+        if (frequency != 0 && (frequency < int(CommandTerminal::Dot()->getMinFrequency()) || frequency > int(CommandTerminal::Dot()->getMaxFrequency()))) {
+            char tmp[256];
+            sprintf(tmp, "Invalid frequency, expects (0,%lu-%lu)", CommandTerminal::Dot()->getMinFrequency(), CommandTerminal::Dot()->getMaxFrequency());
+            CommandTerminal::setErrorMessage(tmp);
+            return false;
+        }
+
+        return true;
+    }
+
+    CommandTerminal::setErrorMessage("Invalid arguments");
+    return false;
+}
+