最终提交
This commit is contained in:
292
4G/源代码/lib/agps9701.lua
Normal file
292
4G/源代码/lib/agps9701.lua
Normal file
@@ -0,0 +1,292 @@
|
||||
--- 模块功能：GPS辅助定位以及星历更新服务.
|
||||
-- 本功能模块只能配合Air512G、Air551G、Air552G使用；
|
||||
-- require"agps"后，会自动开启本功能模块的任务；
|
||||
-- 开机后，仅获取一次基站对应的经纬度位置和当前时间，把经纬度位置和时间写到GPS芯片中，可以加速GPS定位
|
||||
-- 会定期更新GPS星历，星历更新算法如下：
|
||||
-- 从最后一次GPS定位成功的时间算起，每隔4小时连接星历服务器下载一次星历数据（大概4K字节），写入GPS芯片。
|
||||
-- 例如01:00分开机后，更新了一次星历文件，截止到05:00，“一直没有开启过GPS”或者“开启过GPS，但是GPS从来没有定位成功”，在05:00就会下载星历数据然后写入GPS芯片；
|
||||
-- 05:00更新星历数据后，在06:00打开了GPS，并且GPS定位成功，然后在07:00关闭了GPS，关闭前GPS仍然处于定位成功状态；
|
||||
-- 截止到11:00，“一直没有开启过GPS”或者“开启过GPS，但是GPS从来没有定位成功”，在11:00就会下载星历数据然后写入GPS芯片；
|
||||
-- @module agps9701
|
||||
-- @author openLuat
|
||||
-- @license MIT
|
||||
-- @copyright openLuat
|
||||
-- @release 2018.03.26
|
||||
|
||||
require"http"
|
||||
require"lbsLoc"
|
||||
require"net"
|
||||
local gps = require"gps9701"
|
||||
module(..., package.seeall)
|
||||
|
||||
local EPH_TIME_FILE = "/ephTime.txt"
|
||||
local EPH_DATA_FILE = "/ephData.bin"
|
||||
local writeEphIdx,sEphData,writeEphSta = 0
|
||||
local EPH_UPDATE_INTERVAL = 4*3600
|
||||
local lastLbsLng,lastLbsLat = "",""
|
||||
local fneed_xingli=false
|
||||
local cachepack = ""
|
||||
local gpsresult = nil
|
||||
local agpsend = nil
|
||||
local tasklock = true
|
||||
|
||||
--重置写入agps星历包
|
||||
local function agpsreag()
|
||||
tasklock = false
|
||||
sys.taskInit(function()
|
||||
while true do
|
||||
if agpsend then
|
||||
log.info("agpsend")
|
||||
tasklock = true
|
||||
agpsend = false
|
||||
break
|
||||
end
|
||||
sys.wait(1000)
|
||||
if gps.checkdatapack then
|
||||
while true do
|
||||
if agpsend then
|
||||
break
|
||||
end
|
||||
gpsresult = sys.waitUntil("NOEMAL_RECE",1000)
|
||||
if (not gpsresult) and (not agpsend) then
|
||||
gps.writeCmd(cachepack:fromHex(),true)
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
end)
|
||||
end
|
||||
|
||||
local function runTimer()
|
||||
sys.timerStart(updateEph,EPH_UPDATE_INTERVAL*1000)
|
||||
end
|
||||
|
||||
local function writeEphEnd()
|
||||
agpsend = true
|
||||
log.info("agps.writeEphEnd",pack.pack("<i",gps.uartBaudrate):toHex())
|
||||
local cmd,sum = (("AAF00F00950000"):fromHex())..pack.pack("<i",gps.uartBaudrate),0
|
||||
for i=3,cmd:len() do
|
||||
sum = bit.bxor(sum,cmd:byte(i))
|
||||
end
|
||||
local validate = "00AA0F"
|
||||
gps.writeCmd(cmd..string.char(sum)..validate:fromHex(),true)
|
||||
sys.timerStart(gps.close,2000,gps.TIMER,{tag="lib.agps.lua.eph"})
|
||||
writeEphIdx,sEphData,writeEphSta = 0
|
||||
end
|
||||
|
||||
local function writeEph()
|
||||
log.info("agps.writeEph",writeEphSta)
|
||||
if writeEphSta=="IDLE" then
|
||||
if tasklock then
|
||||
agpsreag()
|
||||
end
|
||||
gps.writeCmd("$PGKC149,1,"..gps.uartBaudrate.."*")
|
||||
writeEphSta = "WAIT_BINARY_CMD_ACK"
|
||||
elseif writeEphSta=="WAIT_BINARY_CMD_ACK" or writeEphSta=="WAIT_WRITE_EPH_CMD_ACK" then
|
||||
if sEphData and sEphData:len()>0 then
|
||||
local hexStr = sEphData:sub(1,1024)
|
||||
if hexStr:len()<1024 then hexStr = hexStr..("0"):rep(1024-hexStr:len()) end
|
||||
hexStr = "AAF00C026602"..string.format("%02X",writeEphIdx):upper().."00"..hexStr
|
||||
local checkSum = 0
|
||||
local binStr = hexStr:fromHex()
|
||||
for i=3,binStr:len() do
|
||||
checkSum = bit.bxor(checkSum,binStr:byte(i))
|
||||
end
|
||||
string.format("%02X",checkSum):upper()
|
||||
|
||||
hexStr = hexStr..(string.format("%02X",checkSum):upper()).."00".."AA0F"
|
||||
cachepack = hexStr
|
||||
gps.writeCmd(hexStr:fromHex(),true)
|
||||
|
||||
sEphData = sEphData:sub(1025,-1)
|
||||
writeEphIdx = writeEphIdx+1
|
||||
writeEphSta = "WAIT_WRITE_EPH_CMD_ACK"
|
||||
else
|
||||
gps.writeCmd(("AAF00C006602FFFF6800AA0F"):fromHex(),true)
|
||||
writeEphSta = "WAIT_WRITE_EPH_END_CMD_ACK"
|
||||
end
|
||||
elseif writeEphSta=="WAIT_WRITE_EPH_END_CMD_ACK" then
|
||||
io.writeFile(EPH_TIME_FILE,tostring(os.time()))
|
||||
writeEphEnd()
|
||||
end
|
||||
end
|
||||
|
||||
-- sys.taskInit(function()
|
||||
-- sys.waitUntil()
|
||||
-- while true do
|
||||
-- if agpsend then
|
||||
-- log.info("agpsend")
|
||||
-- break
|
||||
-- end
|
||||
-- sys.wait(1000)
|
||||
-- if gps.checkdatapack then
|
||||
-- while true do
|
||||
-- if agpsend then
|
||||
-- break
|
||||
-- end
|
||||
-- gpsresult = sys.waitUntil("NOEMAL_RECE",1000)
|
||||
-- if (not gpsresult) and (not agpsend) then
|
||||
-- gps.writeCmd(cachepack:fromHex(),true)
|
||||
-- end
|
||||
-- end
|
||||
-- end
|
||||
-- end
|
||||
-- end)
|
||||
|
||||
local function writeEphBegin()
|
||||
writeEphSta = "IDLE"
|
||||
writeEph()
|
||||
end
|
||||
|
||||
local function downloadEphCb(result,prompt,head,body)
|
||||
log.info("agps.downloadEphCb",result,prompt,body)
|
||||
runTimer()
|
||||
if result and prompt=="200" and body then
|
||||
io.writeFile(EPH_DATA_FILE,body)
|
||||
if gps.isFix() then
|
||||
io.writeFile(EPH_TIME_FILE,tostring(os.time()))
|
||||
else
|
||||
fneed_xingli=false
|
||||
sEphData = body:toHex()
|
||||
gps.open(gps.TIMER,{tag="lib.agps.lua.eph",val=10,cb=writeEphEnd})
|
||||
sys.timerStart(writeEphBegin,2000)
|
||||
return
|
||||
end
|
||||
end
|
||||
end
|
||||
|
||||
--连接服务器下载星历
|
||||
function updateEph()
|
||||
if gps.isFix() then runTimer() return end
|
||||
http.request("GET","download.openluat.com/9501-xingli/brdcGPD.dat_rda",nil,nil,nil,20000,downloadEphCb)
|
||||
end
|
||||
|
||||
|
||||
|
||||
--JWL在星历的时间范围内，如果有星历文件，重启模块就直接把本地的星历文件写入GPS芯片
|
||||
--在AGPS_LOCATED 的订阅事件中，调用此接口。
|
||||
function upd_xingli()
|
||||
if not gps.isFix() then
|
||||
local lstm = io.readFile(EPH_TIME_FILE)
|
||||
if not lstm or lstm=="" then return end
|
||||
log.info("agps.upd_xingli lstm=",lstm)
|
||||
if os.time()-tonumber(lstm) < EPH_UPDATE_INTERVAL then
|
||||
local body = io.readFile(EPH_DATA_FILE)
|
||||
if body and #body >0 then
|
||||
log.info("agps.upd_xingli length=",#body)
|
||||
fneed_xingli=false
|
||||
sEphData = body:toHex()
|
||||
gps.open(gps.TIMER,{tag="lib.agps.lua.eph",val=10,cb=writeEphEnd})
|
||||
sys.timerStart(writeEphBegin,2000)
|
||||
else
|
||||
log.info("agps.upd_xingli wanto update xingli data")
|
||||
updateEph()
|
||||
end
|
||||
end
|
||||
end
|
||||
end
|
||||
sys.subscribe("AGPS_LOCATED", function()
|
||||
sys.timerStart(function()
|
||||
log.info("agps.want to upd_xingli",fneed_xingli)
|
||||
if fneed_xingli then
|
||||
upd_xingli()
|
||||
end
|
||||
end,7000)
|
||||
end)
|
||||
|
||||
--检查是否需要更新星历
|
||||
local function checkEph()
|
||||
local result
|
||||
if not gps.isFix() then
|
||||
lastTm = io.readFile(EPH_TIME_FILE)
|
||||
if not lastTm or lastTm=="" then return true end
|
||||
log.info("agps.checkEph",os.time(),tonumber(lastTm)," DELTA=",os.time()-tonumber(lastTm))
|
||||
result = (os.time()-tonumber(lastTm) >= EPH_UPDATE_INTERVAL)
|
||||
end
|
||||
if not result then runTimer() end
|
||||
return result
|
||||
end
|
||||
|
||||
local function setFastFix(lng,lat,tm)
|
||||
gps.setFastFix(lat,lng,tm)
|
||||
if checkEph() then
|
||||
updateEph()
|
||||
end
|
||||
end
|
||||
|
||||
local getloc = 0
|
||||
local lbsLocRequesting
|
||||
--获取到基站对应的经纬度，写到GPS芯片中
|
||||
local function getLocCb(result,lat,lng,addr,time)
|
||||
fneed_xingli=true
|
||||
log.info("agps.getLocCb",result,lat,lng,time and time:len() or 0)
|
||||
lbsLocRequesting = false
|
||||
if result==0 then
|
||||
lastLbsLng,lastLbsLat = lng,lat
|
||||
sys.publish("AGPS_LOCATED", lng,lat)
|
||||
if not gps.isFix() then
|
||||
local tm = {year=0,month=0,day=0,hour=0,min=0,sec=0}
|
||||
if time:len()==6 then
|
||||
tm = {year=time:byte(1)+2000,month=time:byte(2),day=time:byte(3),hour=time:byte(4),min=time:byte(5),sec=time:byte(6)}
|
||||
misc.setClock(tm)
|
||||
tm = common.timeZoneConvert(tm.year,tm.month,tm.day,tm.hour,tm.min,tm.sec,8,0)
|
||||
end
|
||||
gps.open(gps.TIMERORSUC,{tag="lib.agps.lua.fastFix",val=4})
|
||||
sys.timerStart(setFastFix,2000,lng,lat,tm)
|
||||
getloc = 1
|
||||
end
|
||||
end
|
||||
|
||||
if result~=0 or gps.isFix() then
|
||||
if checkEph() then updateEph() end
|
||||
end
|
||||
end
|
||||
|
||||
--是否获取到基站对应的经纬度
|
||||
function isgetloc()
|
||||
return getloc
|
||||
end
|
||||
|
||||
local function ipReady()
|
||||
if gps.isFix() then
|
||||
runTimer()
|
||||
else
|
||||
if not lbsLocRequesting then
|
||||
lbsLocRequesting = true
|
||||
lbsLoc.request(getLocCb,nil,30000,"0","bs.openluat.com","12411",true)
|
||||
end
|
||||
end
|
||||
end
|
||||
|
||||
local function gpsState(evt,para)
|
||||
log.info("agps.GPS_STATE",evt,para)
|
||||
if evt=="LOCATION_SUCCESS" or (evt=="CLOSE" and para==true) then
|
||||
runTimer()
|
||||
elseif evt=="BINARY_CMD_ACK" or evt=="WRITE_EPH_ACK" or evt=="WRITE_EPH_END_ACK" then
|
||||
writeEph()
|
||||
elseif evt=="OPEN" then
|
||||
local lng,lat = gps.getLastLocation()
|
||||
if lng=="" or lat=="" then
|
||||
lng,lat = lastLbsLng,lastLbsLat
|
||||
end
|
||||
if lng~="" and lat~="" then
|
||||
gps.open(gps.TIMERORSUC,{tag="lib.agps.lua.fastFix",val=4})
|
||||
local tm = os.date("*t")
|
||||
sys.timerStart(gps.setFastFix,2000,lat,lng,common.timeZoneConvert(tm.year,tm.month,tm.day,tm.hour,tm.min,tm.sec,8,0))
|
||||
end
|
||||
end
|
||||
end
|
||||
|
||||
function init()
|
||||
sys.subscribe("GPS_STATE",gpsState)
|
||||
sys.subscribe("IP_READY_IND",ipReady)
|
||||
log.info("agps.init")
|
||||
end
|
||||
|
||||
function unInit()
|
||||
sys.unsubscribe("GPS_STATE",gpsState)
|
||||
sys.unsubscribe("IP_READY_IND",ipReady)
|
||||
log.info("agps.unInit")
|
||||
end
|
||||
|
||||
init()
|
||||
Reference in New Issue
Block a user