Merge pull request #419 from daleckystepan/ghost-msp

Ghost MSP support

Author: haslinghuis

src/SCRIPTS/BF/MSP/ghst.lua

@@ -0,0 +1,28 @@
+-- GHST Frame Types
+local GHST_FRAMETYPE_MSP_REQ    = 0x21
+local GHST_FRAMETYPE_MSP_WRITE  = 0x22
+local GHST_FRAMETYPE_MSP_RESP   = 0x28
+
+local ghstMspType = 0
+
+protocol.mspSend = function(payload)
+    return protocol.push(ghstMspType, payload)
+end
+
+protocol.mspRead = function(cmd)
+    ghstMspType = GHST_FRAMETYPE_MSP_REQ
+    return mspSendRequest(cmd, {})
+end
+
+protocol.mspWrite = function(cmd, payload)
+    ghstMspType = GHST_FRAMETYPE_MSP_WRITE
+    return mspSendRequest(cmd, payload)
+end
+
+protocol.mspPoll = function()
+    local type, data = ghostTelemetryPop()
+    if type == GHST_FRAMETYPE_MSP_RESP then
+        return mspReceivedReply(data)
+    end
+    return nil
+end

src/SCRIPTS/BF/protocols.lua

@@ -20,6 +20,16 @@ local supportedProtocols =
         saveMaxRetries  = 2,
         saveTimeout     = 150,
         cms             = {},
+    },
+    ghst =
+    {
+        mspTransport    = "MSP/ghst.lua",
+        push            = ghostTelemetryPush,
+        maxTxBufferSize = 10, -- Tx -> Rx (Push)
+        maxRxBufferSize = 6,  -- Rx -> Tx (Pop)
+        saveMaxRetries  = 2,
+        saveTimeout     = 250,
+        cms             = {},
     }
 }
 
@@ -28,6 +38,8 @@ local function getProtocol()
         return supportedProtocols.smartPort
     elseif supportedProtocols.crsf.push() ~= nil then
         return supportedProtocols.crsf
+    elseif supportedProtocols.ghst.push() ~= nil then
+        return supportedProtocols.ghst
     end
 end