Ghost MSP support

Author: daleckystepan

src/SCRIPTS/BF/MSP/ghost.lua

@@ -0,0 +1,36 @@
+-- GHOST Frame Types
+local GHST_FRAMETYPE_MSP_REQ           = 0x21
+local GHST_FRAMETYPE_MSP_WRITE         = 0x22
+local GHST_FRAMETYPE_MSP_RESP          = 0x28
+
+ghstMspType = 0
+
+protocol.mspSend = function(payload)
+    local payloadOut = { #(payload) }
+    for i=1, #(payload) do
+        payloadOut[i+1] = payload[i]
+    end
+    return protocol.push(ghstMspType, payloadOut)
+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
+        local mspData = {}
+        for i=2, data[1] do
+            mspData[i-1] = data[i]
+        end
+        return mspReceivedReply(mspData)
+    end
+    return nil
+end

src/SCRIPTS/BF/protocols.lua

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