gps9701.lua 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933
  1. --- 模块功能:GPS模块管理
  2. -- 注意:此功能模块中的功能接口可以分为四大类:
  3. -- 1、GPS开启
  4. -- 2、GPS关闭
  5. -- 3、GPS定位数据读取
  6. -- 4、GPS参数和功能设置
  7. -- 1、2、3是通用功能,除了支持合宙的Air512G、Air551G、Air552G模块,理论上也支持其他厂家的串口GPS模块
  8. -- 4是专用功能,仅支持合宙的Air512G、Air551G、Air552G模块
  9. -- @module gps9701
  10. -- @author openLuat
  11. -- @license MIT
  12. -- @copyright openLuat
  13. -- @release 2017.10.23
  14. require"pm"
  15. require"utils"
  16. module(..., package.seeall)
  17. local smatch,sfind,slen,ssub,sbyte,sformat,srep = string.match,string.find,string.len,string.sub,string.byte,string.format,string.rep
  18. --GPS开启标志,true表示开启状态,false或者nil表示关闭状态
  19. local openFlag
  20. --GPS定位标志,"2D"表示2D定位,"3D"表示3D定位,其余表示未定位
  21. --GPS定位标志,true表示,其余表示未定位
  22. local fixFlag,fixOnece=nil,nil
  23. --GPS定位成功后,过滤掉前filterSeconds秒的经纬度信息
  24. --是否已经过滤完成
  25. local filterSeconds,filteredFlag = 0
  26. --从定位成功切换到定位失败,连续定位失败的次数
  27. local fixFailCnt = 0
  28. --经纬度类型和数据
  29. local latitudeType,latitude,longitudeType,longitude = "N","","E",""
  30. --海拔,速度,方向角
  31. local altitude,speed,course = "0","0","0"
  32. --参与定位的卫星个数,所有可见卫星的最大信号值,所有可见卫星的最大信号值中间缓存值
  33. local usedSateCnt,maxSignalStrength,maxSignalStrengthVar = "0",0,0
  34. --可见卫星个数
  35. local viewedGpsSateCnt,viewedBdSateCnt = "0","0"
  36. --可用卫星号,UTC时间,信噪比
  37. local SateSn,UtcTime,Gsv
  38. --大地高,度分经度,度分纬度
  39. local Sep,Ggalng,Ggalat
  40. --是否需要解析项
  41. local psUtcTime,psGsv,psSn
  42. --GPS供电设置函数
  43. local powerCbFnc
  44. --串口配置
  45. uartBaudrate = 115200
  46. local uartID,uartDatabits,uartParity,uartStopbits = 2,8,uart.PAR_NONE,uart.STOP_1
  47. --搜星模式命令字符串,"$PGKC115," .. gps .. "," .. glonass .. "," .. beidou .. "," .. galieo .. "*"
  48. local aerialModeStr,aerialModeSetted = ""
  49. --运行模式命令字符串,"$PGKC105," .. mode .. "," .. rt .. "," .. st .. "*"
  50. local runModeStr,runModeSetted = ""
  51. --正常运行模式下NMEA数据上报间隔命令字符串,"$PGKC101," .. interval .. "*"
  52. local nmeaReportStr,nmeaReportSetted = ""
  53. --每种NEMA数据的输出频率命令字符串
  54. local nmeaReportFreqStr,nmeaReportFreqSetted = ""
  55. --NMEA数据处理模式,0表示仅gps.lua内部处理,1表示仅用户自己处理,2表示gps.lua和用户同时处理
  56. --用户处理一条NMEA数据的回调函数
  57. local nmeaMode,nmeaCbFnc = 0
  58. --NMEA数据输出间隔
  59. local nmeaInterval = 1000
  60. --运行模式
  61. --0,正常运行模式
  62. --1,周期超低功耗跟踪模式
  63. --2,周期低功耗模式
  64. --4,直接进入超低功耗跟踪模式
  65. --8,自动低功耗模式,可以通过串口唤醒
  66. --9, 自动超低功耗跟踪模式,需要force on来唤醒
  67. local runMode = 0
  68. --gps 的串口线程是否在工作;
  69. local taskFlag=false
  70. --runMode为1或者2时,GPS运行状态和休眠状态的时长
  71. local runTime,sleepTime
  72. --检测gps是否工作正常的定时器ID
  73. local workAbnormalTimerId
  74. local agpsver = nil
  75. checkdatapack = false
  76. local testcoro = nil
  77. local i = 0
  78. --[[
  79. 函数名:getstrength
  80. 功能 :解析GSV数据
  81. 参数 :
  82. sg:NEMA中的一行GSV数据
  83. 返回值:无
  84. ]]
  85. local function getstrength(sg)
  86. sg = ssub(sg, 4, #sg)
  87. local d1,d2,curnum,lineno,total,sgv_str = sfind(sg,"GSV,(%d),(%d),(%d+),(.*)%*.*")
  88. if not curnum or not lineno or not total or not sgv_str then
  89. return
  90. end
  91. if lineno == nil then
  92. maxSignalStrengthVar = 0
  93. maxSignalStrength = 0
  94. elseif tonumber(lineno) == 1 then
  95. maxSignalStrength = maxSignalStrengthVar
  96. maxSignalStrengthVar = 0
  97. end
  98. local tmpstr,i = sgv_str
  99. for i=1,4 do
  100. local d1,d2,id,elevation,azimuth,strength = sfind(tmpstr,"(%d+),([%-]*%d*),(%d*),(%d*)")
  101. if id == nil then return end
  102. if strength == "" or not strength then
  103. strength = "00"
  104. end
  105. strength = tonumber(strength)
  106. if strength > maxSignalStrengthVar then
  107. maxSignalStrengthVar = strength
  108. end
  109. local idx,cur,fnd,tmpid = 0,id..","..elevation..","..azimuth..","..strength..",",false
  110. for tmpid in string.gmatch(Gsv,"(%d+),%d*,%d*,%d*,") do
  111. idx = idx + 1
  112. if tmpid == id then fnd = true break end
  113. end
  114. if fnd then
  115. local pattern,i = ""
  116. for i=1,idx do
  117. pattern = pattern.."%d+,%d*,%d*,%d*,"
  118. end
  119. local m1,m2 = sfind(Gsv,"^"..pattern)
  120. if m1 and m2 then
  121. local front = ssub(Gsv,1,m2)
  122. local n1,n2 = sfind(front,"%d+,%d*,%d*,%d*,$")
  123. if n1 and n2 then
  124. Gsv = ssub(Gsv,1,n1-1)..cur..ssub(Gsv,n2+1,-1)
  125. end
  126. end
  127. else
  128. Gsv = Gsv..cur
  129. end
  130. tmpstr = ssub(tmpstr,d2+1,-1)
  131. end
  132. end
  133. local function filterTimerFnc()
  134. log.info("gps.filterTimerFnc end")
  135. filteredFlag = true
  136. end
  137. local function stopWorkAbnormalTimer()
  138. if workAbnormalTimerId then
  139. sys.timerStop(workAbnormalTimerId)
  140. workAbnormalTimerId = nil
  141. end
  142. end
  143. local function parseNmea(s)
  144. if not s or s=="" then return end
  145. local lat,lng,spd,cog,gpsFind,gpsTime,gpsDate,locSateCnt,hdp,latTyp,lngTyp,altd
  146. local hexStr = s:toHex()
  147. if smatch(hexStr,"AAF00D0001009500039A00AA0F") then
  148. sys.publish("GPS_STATE","BINARY_CMD_ACK")
  149. agpsver = true
  150. stopWorkAbnormalTimer()
  151. i= i+1
  152. return
  153. elseif smatch(hexStr,"AAF00D000300") then
  154. sys.publish("GPS_STATE",smatch(hexStr,"^AAF00D000300FFFF") and "WRITE_EPH_END_ACK" or "WRITE_EPH_ACK")
  155. stopWorkAbnormalTimer()
  156. return
  157. end
  158. local fixed,workAbnormal
  159. if smatch(s,"GGA") then
  160. lat,latTyp,lng,lngTyp,gpsFind,locSateCnt,hdp,altd,sep = smatch(s,"GGA,%d+%.%d+,(%d+%.%d+),([NS]),(%d+%.%d+),([EW]),(%d),(%d+),([%d%.]*),(.*),M,(.*),M")
  161. if (gpsFind=="1" or gpsFind=="2" or gpsFind=="4") and altd then
  162. --fixed = true
  163. altitude = altd
  164. latitudeType,longitudeType,latitude,longitude = latTyp,lngTyp,lat,lng
  165. usedSateCnt = locSateCnt
  166. Ggalng,Ggalat = (lngTyp=="W" and "-" or "")..lng,(latTyp=="S" and "-" or "")..lat
  167. Sep = sep
  168. else
  169. fixed = false
  170. end
  171. elseif smatch(s,"RMC") then
  172. gpsTime,gpsFind,lat,latTyp,lng,lngTyp,spd,cog,gpsDate = smatch(s,"RMC,(%d%d%d%d%d%d)%.%d+,(%w),(%d*%.*%d*),([NS]*),(%d*%.*%d*),([EW]*),(.-),(.-),(%d%d%d%d%d%d),")
  173. if gpsFind=="A" and cog then
  174. fixed = true
  175. latitudeType,longitudeType,latitude,longitude = latTyp,lngTyp,lat,lng
  176. speed = spd
  177. course = cog
  178. else
  179. fixed = false
  180. end
  181. if psUtcTime and gpsFind == "A" and gpsTime and gpsDate and gpsTime ~= "" and gpsDate ~= "" then
  182. local yy,mm,dd,h,m,s = tonumber(ssub(gpsDate,5,6)),tonumber(ssub(gpsDate,3,4)),tonumber(ssub(gpsDate,1,2)),tonumber(ssub(gpsTime,1,2)),tonumber(ssub(gpsTime,3,4)),tonumber(ssub(gpsTime,5,6))
  183. UtcTime = {year=2000+yy,month=mm,day=dd,hour=h,min=m,sec=s}
  184. end
  185. elseif smatch(s,"GPGSV") then
  186. viewedGpsSateCnt = tonumber(smatch(s,"%d+,%d+,(%d+)") or "0")
  187. if psGsv then getstrength(s) end
  188. elseif smatch(s,"BDGSV") then
  189. viewedBdSateCnt = tonumber(smatch(s,"%d+,%d+,(%d+)") or "0")
  190. if psGsv then getstrength(s) end
  191. elseif smatch(s,"GSA") then
  192. if psSn then
  193. local satesn = smatch(s,"GSA,%w*,%d*,(%d*,%d*,%d*,%d*,%d*,%d*,%d*,%d*,%d*,%d*,%d*,%d*,)") or ""
  194. if slen(satesn) > 0 and smatch(satesn,"%d+,") then
  195. SateSn = satesn
  196. end
  197. end
  198. else
  199. workAbnormal = true
  200. end
  201. if not workAbnormal then
  202. stopWorkAbnormalTimer()
  203. end
  204. if filterSeconds>0 and fixed and not fixFlag and not filteredFlag then
  205. if not sys.timerIsActive(filterTimerFnc) then
  206. log.info("gps.filterTimerFnc begin")
  207. sys.publish("GPS_STATE","LOCATION_FILTER")
  208. sys.timerStart(filterTimerFnc,filterSeconds*1000)
  209. end
  210. return
  211. end
  212. --定位成功
  213. if fixed then
  214. if not fixFlag then
  215. fixFlag,filteredFlag = true,true
  216. fixOnece=true
  217. fixFailCnt = 0
  218. sys.publish("GPS_STATE","LOCATION_SUCCESS")
  219. end
  220. elseif fixed==false then
  221. if fixFlag then
  222. fixFailCnt = fixFailCnt+1
  223. if fixFailCnt>=20 then
  224. fixFlag,filteredFlag = false
  225. sys.timerStop(filterTimerFnc)
  226. sys.publish("GPS_STATE","LOCATION_FAIL")
  227. end
  228. end
  229. end
  230. end
  231. local function taskRead()
  232. local cacheData = ""
  233. local co = coroutine.running()
  234. while true do
  235. local s =""
  236. if openFlag then
  237. s= uart.read(uartID, "*l")
  238. end
  239. if i==2 then
  240. agpsver =false
  241. i = 0
  242. end
  243. if agpsver then
  244. if s=="" then
  245. checkdatapack = true
  246. else
  247. sys.publish("NOEMAL_RECE")
  248. end
  249. end
  250. if s == "" then
  251. uart.on(uartID,"receive",function() coroutine.resume(co) end)
  252. coroutine.yield()
  253. uart.on(uartID,"receive")
  254. else
  255. cacheData = cacheData..s
  256. if cacheData:toHex()=="AAF00D0001009500039A00AA0F" or smatch(cacheData:toHex(),"AAF00D000300") then
  257. cacheData = cacheData.."\r\n"
  258. end
  259. local d1,d2,nemaStr = sfind(cacheData,"\r\n")--截取串口收到的数据
  260. while d1 do
  261. writePendingCmds()
  262. nemaStr = ssub(cacheData,1,d2)
  263. cacheData = ssub(cacheData,d2+1,-1)
  264. if nmeaMode==0 or nmeaMode==2 then
  265. --解析一行NEMA数据
  266. parseNmea(nemaStr)
  267. end
  268. if (nmeaMode==1 or nmeaMode==2) and nmeaCbFnc then
  269. nmeaCbFnc(nemaStr)
  270. end
  271. d1,d2 = sfind(cacheData,"\r\n")
  272. end
  273. end
  274. end
  275. end
  276. -- GPS串口写命令操作
  277. -- @string cmd,GPS指令(cmd格式:"$PGKC149,1,115200*"或者"$PGKC149,1,115200*XX\r\n")
  278. -- @bool isFull,cmd是否为完整的指令格式,包括校验和以及\r\n;true表示完整,false或者nil为不完整
  279. -- @return nil
  280. -- @usage gps.writeCmd(cmd)
  281. function writeCmd(cmd,isFull)
  282. local tmp = cmd
  283. -- log.info("星历数据5",tmp:toHex())
  284. if not isFull then
  285. tmp = 0
  286. for i=2,cmd:len()-1 do
  287. tmp = bit.bxor(tmp,cmd:byte(i))
  288. end
  289. tmp = cmd..(string.format("%02X",tmp)):upper().."\r\n"
  290. end
  291. -- sys.timerStart(function() uart.write(uartID,tmp) end, 100)
  292. uart.write(uartID,tmp)
  293. -- log.info("gps.writecmd",tmp)
  294. log.info("gps.writecmd:toHex",uartID, tmp:toHex())
  295. end
  296. function writePendingCmds()
  297. if not aerialModeSetted and aerialModeStr~="" then writeCmd(aerialModeStr) aerialModeSetted=true end
  298. if not runModeSetted and runModeStr~="" then writeCmd(runModeStr) runModeSetted=true end
  299. if not nmeaReportSetted and nmeaReportStr~="" then writeCmd(nmeaReportStr) nmeaReportSetted=true end
  300. if not nmeaReportFreqSetted and nmeaReportFreqStr~="" then writeCmd(nmeaReportFreqStr) nmeaReportFreqSetted=true end
  301. end
  302. local function _open()
  303. if openFlag then return end--gps开启状态
  304. pm.wake("gps.lua")
  305. uart.setup(uartID,uartBaudrate,uartDatabits,uartParity,uartStopbits)
  306. if not taskFlag then --串口线程
  307. taskFlag =true
  308. sys.taskInit(taskRead)
  309. end
  310. if powerCbFnc then
  311. powerCbFnc(true)
  312. else
  313. pmd.ldoset(15, pmd.LDO_VMMC)
  314. rtos.sys32k_clk_out(1)
  315. end
  316. openFlag = true
  317. workAbnormalTimerId = sys.timerStart(sys.publish,8000,"GPS_WORK_ABNORMAL_IND")
  318. sys.publish("GPS_STATE","OPEN")
  319. fixFlag,filteredFlag = false
  320. Ggalng,Ggalat,Gsv,Sep = "","",""
  321. log.info("gps._open")
  322. end
  323. local function _close()
  324. if not openFlag then return end
  325. if powerCbFnc then
  326. powerCbFnc(false)
  327. else
  328. pmd.ldoset(0,pmd.LDO_VMMC)
  329. rtos.sys32k_clk_out(0)
  330. end
  331. uart.close(uartID)
  332. pm.sleep("gps.lua")
  333. openFlag = false
  334. sys.publish("GPS_STATE","CLOSE",fixFlag)
  335. stopWorkAbnormalTimer()
  336. fixFlag,filteredFlag = false
  337. sys.timerStop(filterTimerFnc)
  338. Ggalng,Ggalat,Gsv,Sep = "","",""
  339. aerialModeSetted,runModeSetted,nmeaReportSetted,nmeaReportFreqSetted = nil
  340. log.info("gps._close")
  341. end
  342. --- GPS应用模式1.
  343. --
  344. -- 打开GPS后,GPS定位成功时,如果有回调函数,会调用回调函数
  345. --
  346. -- 使用此应用模式调用gps9701.open打开的“GPS应用”,必须主动调用gps9701.close或者gps9701.closeAll才能关闭此“GPS应用”,主动关闭时,即使有回调函数,也不会调用回调函数
  347. DEFAULT = 1
  348. --- GPS应用模式2.
  349. --
  350. -- 打开GPS后,如果在GPS开启最大时长到达时,没有定位成功,如果有回调函数,会调用回调函数,然后自动关闭此“GPS应用”
  351. --
  352. -- 打开GPS后,如果在GPS开启最大时长内,定位成功,如果有回调函数,会调用回调函数,然后自动关闭此“GPS应用”
  353. --
  354. -- 打开GPS后,在自动关闭此“GPS应用”前,可以调用gps9701.close或者gps9701.closeAll主动关闭此“GPS应用”,主动关闭时,即使有回调函数,也不会调用回调函数
  355. TIMERORSUC = 2
  356. --- GPS应用模式3.
  357. --
  358. -- 打开GPS后,在GPS开启最大时长时间到达时,无论是否定位成功,如果有回调函数,会调用回调函数,然后自动关闭此“GPS应用”
  359. --
  360. -- 打开GPS后,在自动关闭此“GPS应用”前,可以调用gps9701.close或者gps9701.closeAll主动关闭此“GPS应用”,主动关闭时,即使有回调函数,也不会调用回调函数
  361. TIMER = 3
  362. --“GPS应用”表
  363. local tList = {}
  364. --[[
  365. 函数名:delItem
  366. 功能 :从“GPS应用”表中删除一项“GPS应用”,并不是真正的删除,只是设置一个无效标志
  367. 参数 :
  368. mode:GPS应用模式
  369. para:
  370. para.tag:“GPS应用”标记
  371. para.val:GPS开启最大时长
  372. para.cb:回调函数
  373. 返回值:无
  374. ]]
  375. local function delItem(mode,para)
  376. for i=1,#tList do
  377. --标志有效 并且 GPS应用模式相同 并且 “GPS应用”标记相同
  378. if tList[i].flag and tList[i].mode==mode and tList[i].para.tag==para.tag then
  379. --设置无效标志
  380. tList[i].flag,tList[i].delay = false
  381. break
  382. end
  383. end
  384. end
  385. --[[
  386. 函数名:addItem
  387. 功能 :新增一项“GPS应用”到“GPS应用”表
  388. 参数 :
  389. mode:GPS应用模式
  390. para:
  391. para.tag:“GPS应用”标记
  392. para.val:GPS开启最大时长
  393. para.cb:回调函数
  394. 返回值:无
  395. ]]
  396. local function addItem(mode,para)
  397. --删除相同的“GPS应用”
  398. delItem(mode,para)
  399. local item,i,fnd = {flag=true, mode=mode, para=para}
  400. --如果是TIMERORSUC或者TIMER模式,初始化GPS工作剩余时间
  401. if mode==TIMERORSUC or mode==TIMER then item.para.remain = para.val end
  402. for i=1,#tList do
  403. --如果存在无效的“GPS应用”项,直接使用此位置
  404. if not tList[i].flag then
  405. tList[i] = item
  406. fnd = true
  407. break
  408. end
  409. end
  410. --新增一项
  411. if not fnd then table.insert(tList,item) end
  412. end
  413. local function existTimerItem()
  414. for i=1,#tList do
  415. if tList[i].flag and (tList[i].mode==TIMERORSUC or tList[i].mode==TIMER or tList[i].para.delay) then return true end
  416. end
  417. end
  418. local function timerFnc()
  419. for i=1,#tList do
  420. if tList[i].flag then
  421. log.info("gps.timerFnc@"..i,tList[i].mode,tList[i].para.tag,tList[i].para.val,tList[i].para.remain,tList[i].para.delay)
  422. local rmn,dly,md,cb = tList[i].para.remain,tList[i].para.delay,tList[i].mode,tList[i].para.cb
  423. if rmn and rmn>0 then
  424. tList[i].para.remain = rmn-1
  425. end
  426. if dly and dly>0 then
  427. tList[i].para.delay = dly-1
  428. end
  429. rmn = tList[i].para.remain
  430. if isFix() and md==TIMER and rmn==0 and not tList[i].para.delay then
  431. tList[i].para.delay = 1
  432. end
  433. dly = tList[i].para.delay
  434. if isFix() then
  435. if dly and dly==0 then
  436. if cb then cb(tList[i].para.tag) end
  437. if md == DEFAULT then
  438. tList[i].para.delay = nil
  439. else
  440. close(md,tList[i].para)
  441. end
  442. end
  443. else
  444. if rmn and rmn == 0 then
  445. if cb then cb(tList[i].para.tag) end
  446. close(md,tList[i].para)
  447. end
  448. end
  449. end
  450. end
  451. if existTimerItem() then sys.timerStart(timerFnc,1000) end
  452. end
  453. --[[
  454. 函数名:statInd
  455. 功能 :处理GPS定位成功的消息
  456. 参数 :
  457. evt:GPS消息类型
  458. 返回值:无
  459. ]]
  460. local function statInd(evt)
  461. --定位成功的消息
  462. if evt == "LOCATION_SUCCESS" then
  463. for i=1,#tList do
  464. log.info("gps.statInd@"..i,tList[i].flag,tList[i].mode,tList[i].para.tag,tList[i].para.val,tList[i].para.remain,tList[i].para.delay,tList[i].para.cb)
  465. if tList[i].flag then
  466. if tList[i].mode ~= TIMER then
  467. tList[i].para.delay = 1
  468. if tList[i].mode == DEFAULT then
  469. if existTimerItem() then sys.timerStart(timerFnc,1000) end
  470. end
  471. end
  472. end
  473. end
  474. end
  475. end
  476. --- 打开一个“GPS应用”
  477. -- “GPS应用”:指的是使用GPS功能的一个应用
  478. -- 例如,假设有如下3种需求,要打开GPS,则一共有3个“GPS应用”:
  479. -- “GPS应用1”:每隔1分钟打开一次GPS
  480. -- “GPS应用2”:设备发生震动时打开GPS
  481. -- “GPS应用3”:收到一条特殊短信时打开GPS
  482. -- 只有所有“GPS应用”都关闭了,才会去真正关闭GPS
  483. -- 每个“GPS应用”打开或者关闭GPS时,最多有4个参数,其中 GPS应用模式和GPS应用标记 共同决定了一个唯一的“GPS应用”:
  484. -- 1、GPS应用模式(必选)
  485. -- 2、GPS应用标记(必选)
  486. -- 3、GPS开启最大时长[可选]
  487. -- 4、回调函数[可选]
  488. -- 例如gps9701.open(gps9701.TIMERORSUC,{tag="TEST",val=120,cb=testGpsCb})
  489. -- gps9701.TIMERORSUC为GPS应用模式,"TEST"为GPS应用标记,120秒为GPS开启最大时长,testGpsCb为回调函数
  490. -- @number mode GPS应用模式,支持gps9701.DEFAULT,gps9701.TIMERORSUC,gps9701.TIMER三种
  491. -- @param para table类型,GPS应用参数
  492. -- para.tag:string类型,GPS应用标记
  493. -- para.val:number类型,GPS应用开启最大时长,mode参数为gps9701.TIMERORSUC或者gps9701.TIMER时,此值才有意义
  494. -- para.cb:GPS应用结束时的回调函数,回调函数的调用形式为para.cb(para.tag)
  495. -- @return nil
  496. -- @usage gps9701.open(gps9701.DEFAULT,{tag="TEST1",cb=test1Cb})
  497. -- @usage gps9701.open(gps9701.TIMERORSUC,{tag="TEST2",val=60,cb=test2Cb})
  498. -- @usage gps9701.open(gps9701.TIMER,{tag="TEST3",val=120,cb=test3Cb})
  499. -- @see DEFAULT,TIMERORSUC,TIMER
  500. function open(mode,para)
  501. assert((para and type(para) == "table" and para.tag and type(para.tag) == "string"),"gps.open para invalid")
  502. log.info("gps.open",mode,para.tag,para.val,para.cb)
  503. --如果GPS定位成功
  504. if isFix() then
  505. if mode~=TIMER then
  506. --执行回调函数
  507. if para.cb then para.cb(para.tag) end
  508. if mode==TIMERORSUC then return end
  509. end
  510. end
  511. addItem(mode,para)--gps应用
  512. --真正去打开GPS
  513. _open()
  514. --启动1秒的定时器
  515. if existTimerItem() and not sys.timerIsActive(timerFnc) then
  516. sys.timerStart(timerFnc,1000)
  517. end
  518. end
  519. --- 关闭一个“GPS应用”
  520. -- 只是从逻辑上关闭一个GPS应用,并不一定真正关闭GPS,是有所有的GPS应用都处于关闭状态,才会去真正关闭GPS
  521. -- @number mode GPS应用模式,支持gps9701.DEFAULT,gps9701.TIMERORSUC,gps9701.TIMER三种
  522. -- @param para table类型,GPS应用参数
  523. -- para.tag:string类型,GPS应用标记
  524. -- para.val:number类型,GPS应用开启最大时长,mode参数为gps9701.TIMERORSUC或者gps9701.TIMER时,此值才有意义;使用close接口时,不需要传入此参数
  525. -- para.cb:GPS应用结束时的回调函数,回调函数的调用形式为para.cb(para.tag);使用close接口时,不需要传入此参数
  526. -- @return nil
  527. -- @usage GPS应用模式和GPS应用标记唯一确定一个“GPS应用”,调用本接口关闭时,mode和para.tag要和gps9701.open打开一个“GPS应用”时传入的mode和para.tag保持一致
  528. -- @usage gps9701.close(gps9701.DEFAULT,{tag="TEST1"})
  529. -- @usage gps9701.close(gps9701.TIMERORSUC,{tag="TEST2"})
  530. -- @usage gps9701.close(gps9701.TIMER,{tag="TEST3"})
  531. -- @see open,DEFAULT,TIMERORSUC,TIMER
  532. function close(mode,para)
  533. assert((para and type(para)=="table" and para.tag and type(para.tag)=="string"),"gps.close para invalid")
  534. log.info("gps.close",mode,para.tag,para.val,para.cb)
  535. --删除此“GPS应用”
  536. delItem(mode,para)
  537. local valid,i
  538. for i=1,#tList do
  539. if tList[i].flag then
  540. valid = true
  541. end
  542. end
  543. --如果没有一个“GPS应用”有效,则关闭GPS
  544. if not valid then _close() end
  545. end
  546. --- 关闭所有“GPS应用”
  547. -- @return nil
  548. -- @usage gps9701.closeAll()
  549. -- @see open,DEFAULT,TIMERORSUC,TIMER
  550. function closeAll()
  551. for i=1,#tList do
  552. if tList[i].flag and tList[i].para.cb then tList[i].para.cb(tList[i].para.tag) end
  553. close(tList[i].mode,tList[i].para)
  554. end
  555. end
  556. --- 判断一个“GPS应用”是否处于激活状态
  557. -- @number mode GPS应用模式,支持gps9701.DEFAULT,gps9701.TIMERORSUC,gps9701.TIMER三种
  558. -- @param para table类型,GPS应用参数
  559. -- para.tag:string类型,GPS应用标记
  560. -- para.val:number类型,GPS应用开启最大时长,mode参数为gps9701.TIMERORSUC或者gps9701.TIMER时,此值才有意义;使用isActive接口时,不需要传入此参数
  561. -- para.cb:GPS应用结束时的回调函数,回调函数的调用形式为para.cb(para.tag);使用isActive接口时,不需要传入此参数
  562. -- @return bool result,处于激活状态返回true,否则返回nil
  563. -- @usage GPS应用模式和GPS应用标记唯一确定一个“GPS应用”,调用本接口查询状态时,mode和para.tag要和gps9701.open打开一个“GPS应用”时传入的mode和para.tag保持一致
  564. -- @usage gps9701.isActive(gps9701.DEFAULT,{tag="TEST1"})
  565. -- @usage gps9701.isActive(gps9701.TIMERORSUC,{tag="TEST2"})
  566. -- @usage gps9701.isActive(gps9701.TIMER,{tag="TEST3"})
  567. -- @see open,DEFAULT,TIMERORSUC,TIMER
  568. function isActive(mode,para)
  569. assert((para and type(para)=="table" and para.tag and type(para.tag)=="string"),"gps.isActive para invalid")
  570. for i=1,#tList do
  571. if tList[i].flag and tList[i].mode==mode and tList[i].para.tag==para.tag then return true end
  572. end
  573. end
  574. --- 设置GPS模块供电控制的回调函数
  575. -- 如果使用的是Air800,或者供电控制使用的是LDO_VCAM,则打开GPS应用前不需要调用此接口进行设置
  576. -- 否则在调用gps9701.open前,使用此接口,传入自定义的供电控制函数cbFnc,GPS开启时,gps9701.lua自动执行cbFnc(true),GPS关闭时,gps9701.lua自动执行cbFnc(false)
  577. -- @param cbFnc function类型,用户自定义的GPS供电控制函数
  578. -- @return nil
  579. -- @usage gps9701.setPowerCbFnc(cbFnc)
  580. function setPowerCbFnc(cbFnc)
  581. powerCbFnc = cbFnc
  582. end
  583. --- 设置GPS模块和GSM模块之间数据通信的串口参数
  584. -- 如果使用的是Air800,或者使用的UART2(波特率115200,数据位8,无检验位,停止位1),则打开GPS应用前不需要调用此接口进行设置
  585. -- 否则在调用gps9701.open前,使用此接口,传入UART参数
  586. -- @number id UART ID,支持1和2,1表示UART1,2表示UART2
  587. -- @number baudrate 波特率,支持1200,2400,4800,9600,10400,14400,19200,28800,38400,57600,76800,115200,230400,460800,576000,921600,1152000,4000000
  588. -- @number databits 数据位,支持8
  589. -- @number parity 校验位,支持uart.PAR_NONE,uart.PAR_EVEN,uart.PAR_ODD
  590. -- @number stopbits 停止位,支持uart.STOP_1,uart.STOP_2
  591. -- @return nil
  592. -- @usage gps9701.setUart(2,115200,8,uart.PAR_NONE,uart.STOP_1)
  593. function setUart(id,baudrate,databits,parity,stopbits)
  594. uartID,uartBaudrate,uartDatabits,uartParity,uartStopbits = id,baudrate,databits,parity,stopbits
  595. end
  596. --- 设置GPS模块搜星模式.
  597. -- 如果使用的是Air800或者Air530,不调用此接口配置,则默认同时开启GPS和北斗定位
  598. -- @number gps GPS定位系统,1是打开,0是关闭
  599. -- @number beidou 中国北斗定位系统,1是打开,0是关闭
  600. -- @number glonass 俄罗斯Glonass定位系统,1是打开,0是关闭
  601. -- @number galieo 欧盟伽利略定位系统,1是打开,0是关闭
  602. -- @return nil
  603. -- @usage gps9701.setAeriaMode(1,1,0,0)
  604. function setAerialMode(gps,beidou,glonass,galieo)
  605. local gps = gps or 0
  606. local glonass = glonass or 0
  607. local beidou = beidou or 0
  608. local galieo = galieo or 0
  609. if gps+glonass+beidou+galieo == 0 then gps=1 beidou=1 end
  610. if gps==1 then gps=1 end
  611. if glonass==1 then glonass=4 end
  612. if beidou==1 then beidou= 8 end
  613. if galieo==1 then galieo= 2 end
  614. local searchstar=gps+glonass+beidou+galieo
  615. searchstar = string.format("%X",searchstar)
  616. log.info("搜星",searchstar)
  617. --local tmpStr = "$PGKC115,"..gps..","..glonass..","..beidou..","..galieo.."*"
  618. local tmpStr = "$PGKC121,0,"..searchstar..",0*"
  619. if tmpStr~=aerialModeStr then
  620. aerialModeStr,aerialModeSetted = tmpStr
  621. end
  622. end
  623. --- 设置NMEA数据处理模式.
  624. -- 如果不调用此接口配置,则默认仅gps.lua内部处理NMEA数据
  625. -- @number mode NMEA数据处理模式,0表示仅gps.lua内部处理,1表示仅用户自己处理,2表示gps.lua和用户同时处理
  626. -- @param cbFnc function类型,用户处理一条NMEA数据的回调函数,mode为1和2时,此值才有意义
  627. -- @return nil
  628. -- @usage gps9701.setNmeaMode(0)
  629. -- @usage gps9701.setNmeaMode(1,cbFnc)
  630. -- @usage gps9701.setNmeaMode(2,cbFnc)
  631. function setNmeaMode(mode,cbFnc)
  632. nmeaMode,nmeaCbFnc = mode,cbFnc
  633. end
  634. --- 设置GPS模块的运行模式.
  635. -- 如果不调用此接口配置,则默认为正常运行模式
  636. -- @number mode 运行模式
  637. -- 0:正常运行模式
  638. -- 1:周期超低功耗跟踪模式
  639. -- 4:直接进入超低功耗跟踪模式
  640. -- 8:低功耗模式,可以通过串口发送命令唤醒
  641. -- @number runTm 单位毫秒,mode为0时表示NEMA数据的上报间隔,mode为1时表示运行时长,其余mode时此值无意义
  642. -- @number sleepTm 单位毫秒,mode为1时表示运行时长,其余mode时此值无意义
  643. -- @return nil
  644. -- @usage gps9701.setRunMode(0,1000)
  645. -- @usage gps9701.setRunMode(1,5000,2000)
  646. function setRunMode(mode,runTm,sleepTm)
  647. local rt,st = runTm or "",sleepTm or ""
  648. if mode==0 and rt then
  649. if rt>10000 then rt=10000 end
  650. if rt<100 then rt=100 end
  651. nmeaReportStr = "$PGKC101,"..rt.."*"
  652. end
  653. local tmpStr = "$PGKC105,"..mode..((mode==1) and (","..rt..","..st) or "").."*"
  654. if tmpStr~=runModeStr then
  655. runModeStr,runModeSetted = tmpStr
  656. end
  657. end
  658. --- 设置NEMA语句的输出频率.
  659. -- @number[opt=1] rmc 单位秒,RMC语句输出频率,取值范围0到10之间的整数,0表示不输出
  660. -- @number[opt=1] gga 单位秒,GGA语句输出频率,取值范围0到10之间的整数,0表示不输出
  661. -- @number[opt=1] gsa 单位秒,GSA语句输出频率,取值范围0到10之间的整数,0表示不输出
  662. -- @number[opt=1] gsv 单位秒,GSV语句输出频率,取值范围0到10之间的整数,0表示不输出
  663. -- @number[opt=1] vtg 单位秒,VTG语句输出频率,取值范围0到10之间的整数,0表示不输出
  664. -- @number[opt=0] gll 单位秒,GLL语句输出频率,取值范围0到10之间的整数,0表示不输出
  665. -- @return nil
  666. -- @usage gps9701.setNemaReportFreq(5,0,0,0,0,0)
  667. function setNemaReportFreq(rmc,gga,gsa,gsv,vtg,gll)
  668. local tmpStr = "$PGKC242,"..(gll or 0)..","..(rmc or 1)..","..(vtg or 1)..","..(gga or 1)..","..(gsa or 1)..","..(gsv or 1)..",0,0,0,0,0,0,0,0,0,0,0,0,0".."*"
  669. if tmpStr~=nmeaReportFreqStr then
  670. nmeaReportFreqStr,nmeaReportFreqSetted = tmpStr
  671. end
  672. end
  673. --- 设置GPS定位成功后经纬度的过滤时间.
  674. -- @number[opt=0] seconds 单位秒,GPS定位成功后,丢弃前seconds秒的位置信息
  675. -- @return nil
  676. -- @usage gps9701.setLocationFilter(2)
  677. function setLocationFilter(seconds)
  678. filterSeconds = seconds or 0
  679. end
  680. function setFastFix(lat,lng,tm)
  681. local t = tm.year..","..tm.month..","..tm.day..","..tm.hour..","..tm.min..","..tm.sec.."*"
  682. log.info("gps.setFastFix",lat,lng,t)
  683. -- writeCmd("$PGKC634,"..t)
  684. writeCmd("$PGKC639,"..lat..","..lng..",0,"..t)
  685. end
  686. --- 获取GPS模块是否处于开启状态
  687. -- @return bool result,true表示开启状态,false或者nil表示关闭状态
  688. -- @usage gps9701.isOpen()
  689. function isOpen()
  690. return openFlag
  691. end
  692. --- 获取GPS模块是否定位成功
  693. -- @return bool result,true表示定位成功,false或者nil表示定位失败
  694. -- @usage gps9701.isFix()
  695. function isFix()
  696. return fixFlag
  697. end
  698. --- 获取GPS模块是否首次定位成功过
  699. -- @return bool result,true表示曾经定位成功
  700. -- @usage gps9701.isOnece()
  701. function isOnece()
  702. return fixOnece
  703. end
  704. -- 度分格式转换为度格式
  705. -- @string inStr 度分格式的位置
  706. -- @return string,度格式的位置
  707. -- @usage degreeMinuteToDegree("3114.50931")--->"31.2418218",31度14.50931分转换为31.2418218度
  708. -- @usage degreeMinuteToDegree("12128.44954")--->"121.4741590",121度28.44954分转换为121.4741590度
  709. local function degreeMinuteToDegree(inStr)
  710. local integer,fraction = smatch(inStr,"(%d+)%.(%d+)")
  711. if integer and fraction then
  712. local intLen = slen(integer)
  713. if intLen~=4 and intLen~=5 then log.error("gps.degreeMinuteToDegree integer error",inStr) return "" end
  714. if slen(fraction)<5 then fraction = fraction..srep("0",5-slen(fraction)) end
  715. fraction = ssub(fraction,1,5)
  716. local temp = tonumber(ssub(integer,intLen-1,intLen)..fraction)*10
  717. fraction = tostring((temp-(temp%6))/6)
  718. local fracLen = slen(fraction)
  719. if fracLen>7 then
  720. fraction = ssub(fraction,1,7)
  721. elseif fracLen<7 then
  722. fraction = srep("0",7-fracLen)..fraction
  723. end
  724. return ssub(integer,1,intLen-2).."."..fraction
  725. end
  726. return ""
  727. end
  728. --- 获取度格式的经纬度信息
  729. -- @string[opt=nil] typ 返回的经纬度格式,typ为"DEGREE_MINUTE"时表示返回度分格式,其余表示返回度格式
  730. -- @return table location
  731. -- 例如typ为"DEGREE_MINUTE"时返回{lngType="E",lng="12128.44954",latType="N",lat="3114.50931"}
  732. -- 例如typ不是"DEGREE_MINUTE"时返回{lngType="E",lng="121.123456",latType="N",lat="31.123456"}
  733. -- lngType:string类型,表示经度类型,取值"E","W"
  734. -- lng:string类型,表示度格式的经度值,无效时为""
  735. -- latType:string类型,表示纬度类型,取值"N","S"
  736. -- lat:string类型,表示度格式的纬度值,无效时为""
  737. -- @usage gps9701.getLocation()
  738. function getLocation(typ)
  739. return {
  740. lngType=longitudeType,
  741. lng=isFix() and (typ=="DEGREE_MINUTE" and longitude or degreeMinuteToDegree(longitude)) or "",
  742. latType=latitudeType,
  743. lat=isFix() and (typ=="DEGREE_MINUTE" and latitude or degreeMinuteToDegree(latitude)) or ""
  744. }
  745. end
  746. function getLastLocation(typ)
  747. if typ=="DEGREE_MINUTE" then
  748. return {
  749. lngType=longitudeType,
  750. lng=longitude,
  751. latType=latitudeType,
  752. lat=latitude
  753. }
  754. else
  755. return (longitude and longitude~="") and degreeMinuteToDegree(longitude) or "", (latitude and latitude~="") and degreeMinuteToDegree(latitude) or ""
  756. end
  757. end
  758. --- 获取海拔
  759. -- @return number altitude,海拔,单位米
  760. -- @usage gps9701.getAltitude()
  761. function getAltitude()
  762. return tonumber(smatch(altitude,"(%d+)") or "0")
  763. end
  764. --- 获取速度
  765. -- @return number kmSpeed,第一个返回值为公里每小时的速度
  766. -- @return number nmSpeed,第二个返回值为海里每小时的速度
  767. -- @usage gps9701.getSpeed()
  768. function getSpeed()
  769. local integer = tonumber(smatch(speed,"(%d+)") or "0")
  770. return (integer*1852 - (integer*1852 %1000))/1000,integer
  771. end
  772. --- 获取原始速度,字符串带浮点
  773. -- @return number speed 海里每小时的速度
  774. -- @usage gps9701.getOrgSpeed()
  775. function getOrgSpeed()
  776. return speed
  777. end
  778. --- 获取方向角
  779. -- @return number course,方向角
  780. -- @usage gps9701.getCourse()
  781. function getCourse()
  782. return tonumber(smatch(course,"(%d+)") or "0")
  783. end
  784. -- 获取所有可见卫星的最大信号强度
  785. -- @return number strength,最大信号强度
  786. -- @usage gps9701.getMaxSignalStrength()
  787. function getMaxSignalStrength()
  788. return maxSignalStrength
  789. end
  790. --- 获取可见卫星的个数
  791. -- @return number count,可见卫星的个数
  792. -- @usage gps9701.getViewedSateCnt()
  793. function getViewedSateCnt()
  794. return tonumber(viewedGpsSateCnt)+tonumber(viewedBdSateCnt)
  795. end
  796. --- 获取定位使用的卫星个数
  797. -- @return number count,定位使用的卫星个数
  798. -- @usage gps9701.getUsedSateCnt()
  799. function getUsedSateCnt()
  800. return tonumber(usedSateCnt)
  801. end
  802. --- 获取GGA语句中度分格式的经纬度信息
  803. -- @return string lng,度分格式的经度值(dddmm.mmmm),西经会添加一个-前缀,无效时为"";例如"12112.3456"表示东经121度12.3456分,"-12112.3456"表示西经121度12.3456分
  804. -- @return string lat,度分格式的纬度值(ddmm.mmmm),南纬会添加一个-前缀,无效时为"";例如"3112.3456"表示北纬31度12.3456分,"-3112.3456"表示南纬31度12.3456分
  805. -- @usage gps9701.getGgaloc()
  806. function getGgaloc()
  807. return Ggalng or "",Ggalat or ""
  808. end
  809. --- 获取RMC语句中的UTC时间
  810. -- 只有同时满足如下两个条件,返回值才有效
  811. -- 1、开启了GPS,并且定位成功
  812. -- 2、调用setParseItem接口,第一个参数设置为true
  813. -- @return table utcTime,UTC时间,nil表示无效,例如{year=2018,month=4,day=24,hour=11,min=52,sec=10}
  814. -- @usage gps9701.getUtcTime()
  815. function getUtcTime()
  816. return UtcTime
  817. end
  818. --- 获取定位使用的大地高
  819. -- @return number sep,大地高
  820. -- @usage gps9701.getSep()
  821. function getSep()
  822. return tonumber(Sep or "0")
  823. end
  824. --- 获取GSA语句中的可见卫星号
  825. -- 只有同时满足如下两个条件,返回值才有效
  826. -- 1、开启了GPS,并且定位成功
  827. -- 2、调用setParseItem接口,第三个参数设置为true
  828. -- @return string viewedSateId,可用卫星号,""表示无效
  829. -- @usage gps9701.getSateSn()
  830. function getSateSn()
  831. return SateSn or ""
  832. end
  833. --- 获取GSV语句中的可见卫星的信噪比
  834. -- 只有同时满足如下两个条件,返回值才有效
  835. -- 1、开启了GPS,并且定位成功
  836. -- 2、调用setParseItem接口,第二个参数设置为true
  837. -- @return string gsv,信噪比
  838. -- @usage gps9701.getGsv()
  839. function getGsv()
  840. return Gsv or ""
  841. end
  842. --- 设置是否需要解析的字段
  843. -- @bool[opt=nil] utcTime 是否解析RMC语句中的UTC时间,true表示解析,false或者nil不解析
  844. -- @bool[opt=nil] gsv 是否解析GSV语句,true表示解析,false或者nil不解析
  845. -- @bool[opt=nil] gsaId 是否解析GSA语句中的卫星ID,true表示解析,false或者nil不解析
  846. -- @usage gps.setParseItem(true,true,true)
  847. function setParseItem(utcTime,gsv,gsaId)
  848. psUtcTime,psGsv,psSn = utcTime,gsv,gsaId
  849. end
  850. function init()
  851. sys.subscribe("GPS_STATE",statInd)
  852. end
  853. function unInit()
  854. sys.unsubscribe("GPS_STATE",statInd)
  855. closeAll()
  856. end
  857. init()