解析ATGM336H-5N的NMEA数据输出 lua-atgm336h-nmea-parser

[Star7-Github]

• Star7
• lua-atgm336h-nmea-parser
• 解析ATGM336H-5N的NMEA数据输出
• 1
• Nothing

local function parseNmeaLine(line)
    if not line or #line < 7 then return end
    if line:sub(1, 1) ~= "$" then return end

    -- 先打印原始数据行
    print(line)

    -- 提取不含校验和的部分用于解析
    local dataPart = line:match("^([^*]+)")
    if not dataPart then return end

    local fields = {}
    for field in dataPart:gmatch("([^,]*)") do
        table.insert(fields, field)
    end

    local sentenceId = fields[1]
    if not sentenceId then return end

    -- 中文输出函数
    local function printInfo(msg)
        print(msg)
    end

    -- 安全获取字段
    local function getField(idx, default)
        return (fields[idx] and fields[idx] ~= "" and fields[idx]) or default
    end

    -- 度分转十进制度
    local function dmToDd(dmStr, isLongitude)
        if dmStr == "" then return "未知" end
        
        local degPart, minPart
        local decimalPointPos = dmStr:find("%.") -- 找到小数点位置
        
        -- if not decimalPointPos then return "未知" end -- 防止没有小数点的异常数据

        if isLongitude then
            -- 经度格式 DDDMM.MMMM (前3位是度)
            degPart = tonumber(dmStr:sub(1, 3)) or 0
            minPart = tonumber(dmStr:sub(4)) or 0
        else
            -- 纬度格式 DDMM.MMMM (前2位是度)
            degPart = tonumber(dmStr:sub(1, 2)) or 0
            minPart = tonumber(dmStr:sub(3)) or 0
        end
        
        -- 总度数 = 整数度 + (分数 / 60)
        local totalDegrees = degPart + (minPart / 60.0)
        
        return string.format("%.6f", totalDegrees)
    end

    -- 系统类型映射
    local systemId = sentenceId:sub(2, 3)
    local systemName = {
        GN = "双模",
        GP = "GPS",
        BD = "北斗"
    }
    local modePrefix = systemName[systemId] or "未知"

    -- 按指定顺序解析
    if sentenceId == "$GNGGA" or sentenceId == "$GPGGA" or sentenceId == "$BDGGA" then
        print("=================================")
        local utcTime = getField(2, "未知")
        local lat = getField(3, "")
        local latDir = getField(4, "")
        local lon = getField(5, "")
        local lonDir = getField(6, "")
        local fixType = getField(7, "0")
        local satellites = getField(8, "0")
        local hdop = getField(9, "未知")
        local altitude = getField(10, "未知")
        local altUnit = getField(11, "米")

        local fixDesc = ({ [0]="无效定位", [1]="单点定位", [2]="差分定位", [6]="估算模式" })[tonumber(fixType)] or "未知模式"
        local latDd = lat ~= "" and dmToDd(lat, false) or "未知"
        local lonDd = lon ~= "" and dmToDd(lon, true) or "未知"

        printInfo("【" .. modePrefix .. " GGA 定位信息】")
        printInfo("  UTC时间: " .. (utcTime ~= "未知" and (utcTime:sub(1,2)..":"..utcTime:sub(3,4)..":"..utcTime:sub(5,6)) or "未知"))
        printInfo("  纬度: " .. latDd .. (latDir == "N" and " 北纬" or latDir == "S" and " 南纬" or ""))
        printInfo("  经度: " .. lonDd .. (lonDir == "E" and " 东经" or lonDir == "W" and " 西经" or ""))
        printInfo("  定位状态: " .. fixDesc)
        printInfo("  可见卫星数: " .. satellites)
        printInfo("  水平精度因子: " .. hdop)
        printInfo("  海拔高度: " .. altitude .. altUnit)
        print("")

    -elseif sentenceId == "$GNGLL" or sentenceId == "$GPGLL" or sentenceId == "$BDGLL" then
        local lat = getField(2, "")
        local latDir = getField(3, "")
        local lon = getField(4, "")
        local lonDir = getField(5, "")
        local utcTime = getField(6, "未知")
        local status = getField(7, "")

        local latDd = lat ~= "" and dmToDd(lat, false) or "未知"
        local lonDd = lon ~= "" and dmToDd(lon, true) or "未知"
        local isValid = status == "A" and "有效" or "无效"

        printInfo("【" .. modePrefix .. " GLL 地理位置信息】")
        printInfo("  纬度: " .. latDd .. (latDir == "N" and " 北纬" or ""))
        printInfo("  经度: " .. lonDd .. (lonDir == "E" and " 东经" or ""))
        printInfo("  UTC时间: " .. (utcTime ~= "未知" and (utcTime:sub(1,2)..":"..utcTime:sub(3,4)..":"..utcTime:sub(5,6)) or "未知"))
        printInfo("  定位数据: " .. isValid)
        print("")

    elseif sentenceId == "$GPGSA" or sentenceId == "$BDGSA" or sentenceId == "$GNGSA" then
        local mode = getField(2, "")
        local fix3d = getField(3, "0")
        local pdop = getField(16, "未知")
        local hdop = getField(17, "未知")
        local vdop = getField(18, "未知")
        
        local fixDesc = ({ [1]="未定位", [2]="二维定位", [3]="三维定位" })[tonumber(fix3d)] or "未知模式"
        
        -- 动态获取系统名称
        local sType = sentenceId:sub(2, 3)
        local sysName = "未知"
        if sType == "GP" then sysName = "GPS"
        elseif sType == "BD" then sysName = "北斗"
        elseif sType == "GN" then sysName = "双模"
        end

        printInfo("【" .. sysName .. " GSA 定位模式】" .. (mode == "A" and "自动" or "手动") .. "，" .. fixDesc)
        printInfo("  PDOP/HDOP/VDOP: " .. pdop .. " / " .. hdop .. " / " .. vdop)
        print("")

    elseif sentenceId == "$GPGSV" then
        local totalMsg = getField(2, "1")
        local msgNum = getField(3, "1")
        local satCount = getField(4, "0")
        if msgNum == "1" then
            printInfo("【GPS GSV 卫星视图】共 " .. satCount .. " 颗卫星可见")
        end
        print("")

    elseif sentenceId == "$BDGSV" then
        local totalMsg = getField(2, "1")
        local msgNum = getField(3, "1")
        local satCount = getField(4, "0")
        if msgNum == "1" then
            printInfo("【北斗 GSV 卫星视图】共 " .. satCount .. " 颗卫星可见")
        end
        print("")

    elseif sentenceId == "$GNRMC" or sentenceId == "$GPRMC" or sentenceId == "$BDRMC" then
        local utcTime = getField(2, "未知")
        local status = getField(3, "")
        local lat = getField(4, "")
        local latDir = getField(5, "")
        local lon = getField(6, "")
        local lonDir = getField(7, "")
        local speedKnots = getField(8, "0")
        local course = getField(9, "0")
        local date = getField(10, "未知")

        local isValid = status == "A" and "有效" or "无效"
        local speedKmph = tonumber(speedKnots) and string.format("%.2f", tonumber(speedKnots) * 1.852) or "0.00"
        local latDd = lat ~= "" and dmToDd(lat, false) or "未知"
        local lonDd = lon ~= "" and dmToDd(lon, true) or "未知"

        printInfo("【" .. modePrefix .. " RMC 最简定位信息】")
        if date ~= "未知" then
            printInfo("  日期: 20" .. date:sub(5,6) .. "-" .. date:sub(3,4) .. "-" .. date:sub(1,2))
        end
        printInfo("  UTC时间: " .. (utcTime ~= "未知" and (utcTime:sub(1,2)..":"..utcTime:sub(3,4)..":"..utcTime:sub(5,6)) or "未知"))
        printInfo("  定位状态: " .. isValid)
        printInfo("  纬度: " .. latDd .. (latDir == "N" and " 北纬" or ""))
        printInfo("  经度: " .. lonDd .. (lonDir == "E" and " 东经" or ""))
        printInfo("  地面速度: " .. speedKmph .. " 公里/小时")
        printInfo("  航向: " .. course .. " 度")
        print("")

    elseif sentenceId == "$GNVTG" or sentenceId == "$GPVTG" then
        local courseTrue = getField(2, "0")
        local speedKnots = getField(6, "0")
        local speedKmph = tonumber(speedKnots) and string.format("%.2f", tonumber(speedKnots) * 1.852) or "0.00"
        printInfo("【" .. modePrefix .. " VTG 地面速度与航向】航向 " .. courseTrue .. "°，速度 " .. speedKmph .. " 公里/小时")
        print("")

    elseif sentenceId == "$GNZDA" or sentenceId == "$GPZDA" then
        local utcTime = getField(2, "未知")
        local day = getField(3, "00")
        local month = getField(4, "00")
        local year = getField(5, "0000")
        printInfo("【" .. modePrefix .. " ZDA 日期时间】UTC " .. year .. "-" .. month .. "-" .. day .. " " ..
                  (utcTime:sub(1,2) .. ":" .. utcTime:sub(3,4) .. ":" .. utcTime:sub(5,6)))
        print("")
   
    elseif sentenceId == "$GPTXT" then
        local text = getField(5, "无内容")
        printInfo("【天线】" .. text)

    else
        -- 打印未识别语句
        -- printInfo("【未处理语句】" .. sentenceId)
    end
end

-- 注册串口接收回调
apiSetCb("uart", function(data)
    for line in (data .. "\n"):gmatch("([^\r\n]*)\r?\n") do
        if line and #line > 0 then
            parseNmeaLine(line)
        end
    end
end)