292 lines
9.8 KiB
Lua
292 lines
9.8 KiB
Lua
--- 模块功能：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() |