Air724ugLora/drv_periph/sx126x_driver.lua

--- 模块功能：sx126x模块驱动
-- 读取FLASH ID
-- @author openLuat
-- @module spi.testSpiFlash
-- @license MIT
-- @copyright openLuat
-- @release 2018.03.27

module(...,package.seeall)

require"utils"
require"pm"
pm.wake("wake11")
require"pins"
-- require "sx126x_reg"
require "Drv_spi"
require "sx126x_reg"
-- TODU: 驱动文件要分开。我把redio.c的函数放到了驱动里面了，为了方便调试。

pmd.ldoset(2,pmd.LDO_VMMC)
pmd.ldoset(2,pmd.LDO_VLCD)
local SX126x = json.encode(sx126x_reg.SX126x_t)
local SX126xCopy,result,errinfo = json.decode(SX126x)
SX126x = nil
local ImageCalibrated = false

local FREQ_STEP = 0.95367431640625

local RadioPublicNetwork_t = {
    Previous = false,
    Current  = false
}

RadioPublicNetwork = RadioPublicNetwork_t

SX126xResetGPIO = pins.setup(pio.P0_13,0)

SX126xTXENGPIO = pins.setup(pio.P0_27,1)
SX126xRXENGPIO = pins.setup(pio.P0_28,0)

function setTransmitMode()
    sys.wait(100)
    SX126xTXENGPIO(1)
    SX126xRXENGPIO(0)
    sys.wait(100)
end

function setReceiveMode()
    sys.wait(100)
    SX126xTXENGPIO(0)
    SX126xRXENGPIO(1)
    sys.wait(100)
end 
-- local getGpio19Fnc = pins.setup(pio.P0_24)
-- sys.timerLoopStart(function()
--     log.info("testGpioSingle.getGpio19Fnc",getGpio19Fnc())
-- end,1000)


-- function gpio13IntFnc(msg)
--     log.info("testGpioSingle.gpio24IntFnc",msg,getGpio13Fnc())
--     --上升沿中断
--     if msg==cpu.INT_GPIO_POSEDGE then
--     --下降沿中断
--     else
--     end
-- end
pio.pin.setdebounce(0xffffffff)
--GPIO13配置为中断，可通过getGpio13Fnc()获取输入电平，产生中断时，自动执行gpio13IntFnc函数
-- getGpio13Fnc = pins.setup(pio.P0_24,gpio13IntFnc)






function gpio4IntFnc(msg)
    log.info("testGpioSingle.gpio4IntFnc",msg,getGpio4Fnc())
    --上升沿中断
    if msg==cpu.INT_GPIO_POSEDGE then
        sys.publish("LORA_CALL_BACK")
    --下降沿中断
    else
    end
end

--GPIO13配置为中断，可通过getGpio13Fnc()获取输入电平，产生中断时，自动执行gpio13IntFnc函数
getGpio4Fnc = pins.setup(pio.P0_4,gpio4IntFnc)

OperatingMode = sx126x_reg.RadioStandbyModes_t.STDBY_RC


function stringToHex(str)
    local hex = {}
    for i = 1, #str do
        local byte = string.byte(str, i)
        hex[#hex + 1] = string.format("%02x", byte)
    end
    return table.concat(hex)
end

function gsonLoginfo(data)
    local jsondata = json.encode(data)
    log.info("SX126xSetModulationParams.encode",jsondata)
end

-- 初始化SPI
function SX126xIoInit()
    Drv_spi.SPI_GPIO_Init()
end

-- 复位SX126x
function SX126xReset()
    sys.wait(10) 
    SX126xResetGPIO(0)
    sys.wait(20)
    SX126xResetGPIO(1)
    sys.wait(10) 
end

function SX126xWakeup()
    local command = sx126x_reg.RadioCommands.RADIO_GET_STATUS .. "00"
    local ret = Drv_spi.drv_spi_read_write_byte(command)
    log.info("SX126xWakeup",ret)
end

--命令写入 完成
function SX126xWriteCommand(command,buffer)
    local bufferTotal = ""
    for i, num in ipairs(buffer) do
        bufferTotal = bufferTotal .. num
    end
    Drv_spi.drv_spi_read_write_byte(command .. bufferTotal,0)
    -- 50
    -- sys.wait(20)
    -- Drv_spi.drv_spi_read_write_byte(bufferTotal,0)
    -- local ret = Drv_spi.drv_spi_read_write_byte("1d07400000",1);
    -- log.info("SX126xWriteCommand",Drv_spi.drv_spi_read_write_byte(bufferTotal,1))

end

function SX126xReadCommand(command,size)
    -- Drv_spi.drv_spi_read_write_byte(command,0)
    for i = 1, size do
        command = command .. "00"
    end

    local ret = Drv_spi.drv_spi_read_write_byte(command,size)
    -- Drv_spi.drv_spi_read_write_byte(command,0)
    log.info("SX126xReadCommand",ret)
    return ret
end
-- -----------------------------------------------SPI基础读写---------------------------------------------------
-- 读取寄存器 完成
function SX126xReadRegisters(address,size)
    Drv_spi.drv_spi_read_write_byte(sx126x_reg.RadioCommands.RADIO_READ_REGISTER,0)
    -- sys.wait(20)
    local sendData = address .. "00"
    local receiverDataCount= size

    while size > 0 do
        sendData = sendData .. "00"
        size = size - 1
    end

    local result = Drv_spi.drv_spi_read_write_byte(sendData,receiverDataCount)  --这里乘2的意思是，16进制是两位，但是转成字符串的形式就是4位了。

    log.info("SX126xReadRegisters",result)
    return result
end

--封装后的读寄存器
function SX126xReadRegister(address)
    local ret = SX126xReadRegisters(address,1)
    return ret
end

-- 写入寄存器
function SX126xWriteRegisters(address,buffer)
    local bufferTotal = ""
    Drv_spi.drv_spi_read_write_byte(sx126x_reg.RadioCommands.RADIO_WRITE_REGISTER,0)
    sys.wait(20)
    for i, data in ipairs(buffer) do
        bufferTotal = bufferTotal .. data
    end

    local test = address .. bufferTotal
    log.info("SX126xWriteRegisters",bufferTotal)
    Drv_spi.drv_spi_read_write_byte(test,0);
end

function SX126xWriteRegister(address,value)
    SX126xWriteRegisters( address,value);
end



function SX126xSetStandby(standbyConfig)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_STANDBY,{standbyConfig})
    -- log.info("SX126xSetStandby_操作模式",standbyConfig)

    if standbyConfig == sx126x_reg.RadioStandbyModes_t.STDBY_RC then
        OperatingMode = sx126x_reg.RadioStandbyModes_t.STDBY_RC
    else
        OperatingMode = sx126x_reg.RadioStandbyModes_t.STDBY_XOSC
    end
end

function SX126xSetRegulatorMode(mode)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_REGULATORMODE,{mode})
end

function SX126xSetBufferBaseAddress(txBaseAddress, rxBaseAddress)
    local buf = {txBaseAddress,rxBaseAddress}
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_BUFFERBASEADDRESS,buf)
end

function SX126xSetPaConfig(paDutyCycle,hpMax,deviceSel,paLut)
    local buf = {paDutyCycle,hpMax,deviceSel,paLut}
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_PACONFIG,buf)
    log.info("SX126xSetPaConfig",sx126x_reg.RadioCommands.RADIO_SET_PACONFIG)
end

function SX126xSetTxParams(power, rampTime)
    local buf = {power,rampTime}
    SX126xSetPaConfig("04","07","00","01")
    SX126xWriteRegister( sx126x_reg.REG_OCP, {"38"} )
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_TXPARAMS,buf)

end

-- function SX126xSetDioIrqParams2222(timeout, freq, rfChain, power, preambleLen)
--     local buf = {timeout, freq, rfChain, power, preambleLen}
--     SX126xSetTxParams(power, sx126x_reg.RadioRampTimes_t.RADIO_RAMP_40_US)
--     SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_TX,buf)
-- end

-- TODU : 参数配置问题，好像并不影响发生。这里主要是配置中断设置的。
function SX126xSetDioIrqParams(irqMask, dio1Mask, dio2Mask, dio3Mask )
    local buf = {"02","01","02","01","00","00","00","00"}
    buf[2] = irqMask
    buf[4] = irqMask
    local jsondata = json.encode(buf)
    log.info("SX126xSetModulationParams.encode",jsondata)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_CFG_DIOIRQ,buf)
end


function SX126xSetStopRxTimerOnPreambleDetect(enable)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_STOPRXTIMERONPREAMBLE,{enable})
end

function SX126xSetLoRaSymbNumTimeout(SymbNum)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_LORASYMBTIMEOUT,{SymbNum})
end

function SX126xSetPacketType(packetType)
    PacketType = packetType;
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_SET_PACKETTYPE,{PacketType})
    log.info("PacketType:",PacketType,sx126x_reg.RadioCommands.RADIO_SET_PACKETTYPE)
end

-- 原驱动好像并没有启用，不晓得这个是什么功能
function RadioSetPublicNetwork(enable)
    SX126xSetPacketType(sx126x_reg.RadioPacketTypes_t.PACKET_TYPE_LORA)
    if enable == true then
        SX126xWriteRegister( sx126x_reg.REG_LR_SYNCWORD,{"07"});
        SX126xWriteRegister( sx126x_reg.REG_LR_SYNCWORD_LSB,{"40"});
    else
        SX126xWriteRegister( sx126x_reg.REG_LR_SYNCWORD, {"07"});
        SX126xWriteRegister( sx126x_reg.REG_LR_SYNCWORD_LSB, {"41"} );
    end
end


function RadioSetModem(modem)
    if modem == sx126x_reg.RadioModems_t.MODEM_FSK then
        -- 处理 FSK 调制的逻辑
        -- SX126xSetPacketType(sx126x_reg.RadioPacketTypes_t.PACKET_TYPE_GFSK)
    elseif modem == sx126x_reg.RadioModems_t.MODEM_LORA then
        SX126xSetPacketType(sx126x_reg.RadioPacketTypes_t.PACKET_TYPE_LORA)
        if RadioPublicNetwork.Current ~= RadioPublicNetwork.Previous then
            RadioPublicNetwork.Current = RadioPublicNetwork.Previous
            RadioSetPublicNetwork(RadioPublicNetwork.Current)
        end
    else
        -- 处理未知调制类型的逻辑
        print("错误：未知的调制类型")
    end
end  -- 增加了函数结束标记

function SX126xSetModulationParams(modulationParams)
    buf = {modulationParams.Params.LoRa.SpreadingFactor, 
    modulationParams.Params.LoRa.Bandwidth,
    modulationParams.Params.LoRa.CodingRate, 
    modulationParams.Params.LoRa.LowDatarateOptimize
    }
    local jsondata = json.encode(buf)
    log.info("SX126xSetModulationParams.encode",jsondata)
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_SET_MODULATIONPARAMS,buf);
end


function SX126xSetPacketParams(packetParams)
    buf = { "00",
            packetParams.Params.LoRa.PreambleLength, 
            packetParams.Params.LoRa.HeaderType, 
            packetParams.Params.LoRa.PayloadLength, 
            packetParams.Params.LoRa.CrcMode, 
            packetParams.Params.LoRa.InvertIQ}
    -- local jsondata = json.encode(buf)
    -- log.info("SX126xSetPacketParams.encode",jsondata)
    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_SET_PACKETPARAMS,buf);
end

--[[
        modem : sx126x_reg.RadioModems_t.MODEM_LORA
        power : 22 = 16
        fdev  : 0  = 0
        bandwidth : 2
        datarate : 11
        coderate : 1
        preambleLen : 12
        fixLen : false
        crcOn : true
        freqHopOn : false
        hopPeriod : 0
        iqInverted : 0
        timeout : 3000
]]
--                   MODEM_LORA  16    0       1       7      1           12      false    true    false       0        0         3000
function RadioSetTxConfig(modem,power,fdev,bandwidth,datarate,coderate,preambleLen,fixLen,crcOn,freqHopOn,hopPeriod,iqInverted,timeout)
    SX126xSetStopRxTimerOnPreambleDetect("00")  -- = flase
    SX126xSetLoRaSymbNumTimeout("00")
    SX126xCopy.ModulationParams.PacketType = sx126x_reg.RadioPacketTypes_t.PACKET_TYPE_LORA

	SX126xCopy.ModulationParams.Params.LoRa.SpreadingFactor = string.format("%02X", datarate)
	SX126xCopy.ModulationParams.Params.LoRa.Bandwidth =  "05"
	SX126xCopy.ModulationParams.Params.LoRa.CodingRate= coderate

    if ( (bandwidth == 0) and ( (datarate == 11) or (datarate == 12) ) ) or ( (bandwidth == 1) and (datarate == 12) ) then
        SX126xCopy.ModulationParams.Params.LoRa.LowDatarateOptimize = "01"
    else
        SX126xCopy.ModulationParams.Params.LoRa.LowDatarateOptimize = "00"
    end
    -- SX126xCopy.ModulationParams.Params.LoRa.LowDatarateOptimize = "00"


    
    SX126xCopy.PacketParams.PacketType = sx126x_reg.RadioPacketTypes_t.PACKET_TYPE_LORA

    SX126xCopy.PacketParams.Params.LoRa.PreambleLength = preambleLen

    SX126xCopy.PacketParams.Params.LoRa.HeaderType = fixLen
    -- TODU:这里的FF写死了，应该不要写死。
	SX126xCopy.PacketParams.Params.LoRa.PayloadLength = "FF"
	SX126xCopy.PacketParams.Params.LoRa.CrcMode = crcOn
	SX126xCopy.PacketParams.Params.LoRa.InvertIQ = iqInverted
    -- gsonLoginfo("SX126xCopy",SX126xCopy.PacketParams.Params.LoRa)

    SX126xSetStandby(sx126x_reg.RadioStandbyModes_t.STDBY_RC)
    RadioSetModem(sx126x_reg.RadioModems_t.MODEM_LORA)
    SX126xSetModulationParams(SX126xCopy.ModulationParams)
    SX126xSetPacketParams(SX126xCopy.PacketParams)
    SX126xSetTxParams(power,sx126x_reg.RadioRampTimes_t.RADIO_RAMP_40_US)
end

function SX126xCalibrateImage(freq)
    local calFreq = {}

    if freq > 900000000 then
        calFreq = {"E1", "E9"}
    elseif freq > 850000000 then
        calFreq = {"D7", "D8"}
    elseif freq > 770000000 then
        calFreq = {"C1", "C5"}
    elseif freq > 460000000 then
        calFreq = {"75", "81"}
    elseif freq > 425000000 then
        calFreq = {"6B", "6F"}
    elseif freq >= 210000000 then
        calFreq = {"37", "41"}
    end

    SX126xWriteCommand(sx126x_reg.RadioCommands.RADIO_CALIBRATEIMAGE, calFreq)
end


function SX126xSetRfFrequency(frequency)
    
    local buf = {}
    local freq = 0

    if ImageCalibrated == false then
        SX126xCalibrateImage(frequency)
        ImageCalibrated = true
    end
    -- local FREQ_STEP = 0.95367431640625

    freq = frequency / FREQ_STEP
    
    log.info("freq", freq)
    log.info("freq", string.format("%02X", freq))
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_SET_RFFREQUENCY, {string.format("%02X", freq)});
end

function RadioSetChannel(frequency) 
    SX126xSetRfFrequency(frequency)
end

function SX126xWriteBuffer(offset, buffer,size) 
    -- log.info("SX126xWriteBuffer",offset,buffer,size)
    local sentdata = offset .. buffer
    Drv_spi.drv_spi_read_write_byte(sx126x_reg.RadioCommands.RADIO_WRITE_BUFFER,0)
    Drv_spi.drv_spi_read_write_byte(sentdata,10)

end

function SX126xSetPayload (payload,size)
    -- log.info("SX126xSetPayload",payload,size)
    SX126xWriteBuffer( "00", payload, size );
end

function SX126xSetTx(timeout) 
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_SET_TX, {timeout});
end


function SX126xSendPayload(payload,size,timeout) 
    -- log.info("SX126xSendPayload",payload,size,timeout)
    SX126xSetPayload( payload, size );
    SX126xSetTx( timeout );
end

function RadioSend(buffer,size,time_out) 
    SX126xSetDioIrqParams( "01", sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE )--SX126xSetDioIrqParams( sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE )
    log.info("RadioSend",buffer,size,time_out)
    SX126xCopy.PacketParams.Params.LoRa.PayloadLength = size
    SX126xSetPacketParams(SX126xCopy.PacketParams)
    SX126xSendPayload(buffer,size,time_out)
end


-- 初始化SX126x
function SX126xInit()
    SX126xIoInit()
    SX126xReset()
    SX126xWakeup()
    SX126xSetStandby(sx126x_reg.RadioStandbyModes_t.STDBY_RC)
    -- SX126xSetRegulatorMode(sx126x_reg.RadioStandbyModes_t.USE_DCDC)
    -- SX126xSetBufferBaseAddress("00","00")
    -- SX126xSetTxParams( "00", sx126x_reg.RadioRampTimes_t.RADIO_RAMP_200_US )
    -- SX126xSetDioIrqParams( sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE )

    -- SX126xSetStandby(sx126x_reg.RadioStandbyModes_t.STDBY_RC)

    -- sys.wait(2000)
    

    -- log.info("RadioSetTxConfig",string.format("%02X", 433000000))
    -- RadioSetChannel(433000000) 
end

function sentString(strData)
    --这里需要判断传入的是否为字符串。
    local hexStr = stringToHex(strData)
    RadioSend(hexStr,string.format("%02X", #hexStr/2),"00") 
        --     local original = "Hello, Lua!\n"
        -- local hexStr = stringToHex(original)
        log.info("test:",hexStr)  -- 输出: 48656c6c6f2c204c756121
        log.info("testlen:",#hexStr)
        log.info("testlen2:",string.format("%02X", #hexStr/2))
        -- RadioSend(hexStr,string.format("%02X", #hexStr/2),"00") 
end

function SX126xSetRx(timeout)
    OperatingMode = sx126x_reg.RadioOperatingModes_t.MODE_RX 
    local buf = {"00","00","00"} 
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_SET_RX, buf);  
end


function RadioRx()
    pins.setup(pio.P0_27,0)
    pins.setup(pio.P0_28,1)
    -- sys.wait(1000)
    SX126xSetDioIrqParams( "02", sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_ALL, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE, sx126x_reg.RadioIrqMasks_t.IRQ_RADIO_NONE )
    SX126xSetRx(0)
end

function SX126xClearIrqStatus()
    local buf = {"FF","FF"}
    SX126xWriteCommand( sx126x_reg.RadioCommands.RADIO_CLR_IRQSTATUS, buf);  
end


function RadioClearIrqStatus()
    SX126xClearIrqStatus()
end

-- function SX126xGetRxBufferStatus()
--     local ret = SX126xReadCommand( sx126x_reg.RadioCommands.RADIO_GET_RXBUFFERSTATUS, 4 )
--     log.info("LORA_CALL_BACK",ret)
--     return ret
-- end

-- function SX126xGetPayload(buffer,size,maxSize)
--     local offset = "00"
--     local data = SX126xGetRxBufferStatus(size,offset) --例子：返回 "A408"   A4是起始地址，08是接收到的长度

--     if size > maxSize then
--         return -1
--     end
--     SX126xReadBuffer(offset,buffer,size)
--     return 0
-- end

-- function RadioGetBuffer()

-- end 

-- function loraCallback()

-- end 

function SX126xReadBuffer(offset,size)
    local command = sx126x_reg.RadioCommands.RADIO_READ_BUFFER .. offset .. "00"
    -- Drv_spi.drv_spi_read_write_byte(sx126x_reg.RadioCommands.RADIO_READ_BUFFER)

    for i = 1, size do
        command = command .. "00"
    end
    -- log.info("offset",offset)
    -- log.info("SX126xReadBuffer",ret)
    -- log.info("SX126xReadBuffer",command)
    local ret = Drv_spi.drv_spi_read_write_byte(command,8)
    log.info("SX126xReadBuffer",ret)
end


sys.subscribe("LORA_CALL_BACK", function()
    RadioClearIrqStatus()
    RadioRx()
    log.info("清除中断")
    local ret = SX126xReadCommand( sx126x_reg.RadioCommands.RADIO_GET_RXBUFFERSTATUS, 3 )
    log.info("LORA_CALL_BACK",ret)
    -- 从第1个字符截取到第2个字符，得到"A4"
    local rxStartBufferPointer = ret:sub(1, 2)

    -- 从第3个字符截取到第4个字符，得到"08"
    local payloadLength = ret:sub(3, 4)

    local num1 = tonumber(payloadLength, 16)  -- 第二个参数 16 表示按十六进制解析
    local nmu2 = tonumber("FF", 16)

    -- print(string.format("0x%02X", nmu2))  -- 输出 0x08（十六进制格式化显示）

    if num1 >= nmu2 then
        -- print(string.format("0x%02X", nmu1))  -- 输出 0x08（十六进制格式化显示）
        return 1
    end

    log.info("payloadLength: "..payloadLength)
    log.info("payloadLength: "..rxStartBufferPointer)
    SX126xReadBuffer("00",8)

    -- print(part1)  -- 输出 "A4"
    -- print(part2)  -- 输出 "08"
    -- SX126xReadRegister("0702")
end)

-- sys.taskInit(function ()
--     sys.wait(5000)
--     SX126xInit()
--     sys.wait(2000)
--     while true do
--         log.info("计算结果")
--         --[[
--             1.将普通字符串用函数转换成16进制字符串，并获取表长度。例如："Hello, Lua!" -> "48656c6c6f2c204c756121"
--             2.返回的16进制表，是以两位为一个16进制数据,实际发生长需要减半。例如："48656c6c6f2c204c756121" -> 0x48 0x65 ... 0x21 
--             3.RadioSend的第二位参数是要发生的数据长度，需要16进制字符串形式，意味着"48656c6c6f2c204c756121"是11位数据
--                 但是是需要转成 "08"。
--         ]]
--         sentString("hello,My_name_is_XuXinyi\n")
--         -- local original = "Hello, Lua!\n"
--         -- local hexStr = stringToHex(original)
--         -- log.info("test:",hexStr)  -- 输出: 48656c6c6f2c204c756121
--         -- log.info("testlen:",#hexStr)
--         -- RadioSend(hexStr,string.format("%02X", #hexStr/2),"00") 
--         -- sys.wait(20)
--         -- SX126xReadCommand(sx126x_reg.RadioCommands.RADIO_GET_STATUS,1)
--         -- SX126xWakeup()
--         sys.wait(4000)
--     end
--     spi.close(spi.SPI_1)
-- end)