autoGPS.lua 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252
  1. --- 模块功能:GPS自适应
  2. -- @author openLuat
  3. -- @module autoGps.task
  4. -- @license MIT
  5. -- @copyright openLuat
  6. -- @release 2021.09.09
  7. module(...,package.seeall)
  8. --记录gps型号和串口波特率
  9. local GPS_KIND_INFO_FILE = "/GPSKINDINFO.txt"
  10. --写实际接的串口号
  11. --Air820模块内部,gps芯片使用的是串口3
  12. local UART_ID = 3
  13. --串口接收数据缓冲区
  14. local rdBuf = ""
  15. --gps芯片型号
  16. local gpsKind=""
  17. --自适应的gps、agps功能库
  18. local gpsLib,agpsLib="",""
  19. --自适应串口波特率
  20. --默认从115200开始轮询
  21. local uartBaudrate=115200
  22. --其他串口参数
  23. local uartDatabits,uartParity,uartStopbits = 8,uart.PAR_NONE,uart.STOP_1
  24. function writeCmd(cmd,isFull)
  25. local tmp = cmd
  26. if not isFull then
  27. tmp = 0
  28. for i=2,cmd:len()-1 do
  29. tmp = bit.bxor(tmp,cmd:byte(i))
  30. end
  31. tmp = cmd..(string.format("%02X",tmp)):upper().."\r\n"
  32. end
  33. uart.write(UART_ID,tmp)
  34. log.info("autoGPS.writeCmd",tmp)
  35. end
  36. --解析GPS种类
  37. local function parse(data)
  38. if not data then return end
  39. local tInfo =
  40. {
  41. {keyWord="UC6226",kind="530H"},
  42. {keyWord="GOKE",kind="530"},
  43. {keyWord="GK",kind="530"},
  44. {keyWord="URANUS5",kind="530Z"},
  45. {keyWord="ANTENNA",kind="530Z"},
  46. }
  47. for i=1,#tInfo do
  48. if data:match(tInfo[i].keyWord) then
  49. gpsKind=tInfo[i].kind
  50. log.info("autoGPS.parse",gpsKind)
  51. uart.close(UART_ID)
  52. sys.publish("GPS_KIND",gpsKind)
  53. return true,""
  54. end
  55. end
  56. return false,data
  57. end
  58. --缓冲拼接
  59. local function proc(data)
  60. if not data or string.len(data) == 0 then return end
  61. --追加到缓冲区
  62. rdBuf = rdBuf..data
  63. local result,unproc
  64. unproc = rdBuf
  65. --根据帧结构循环解析未处理过的数据
  66. while true do
  67. result,unproc = parse(unproc)
  68. if not unproc or unproc == "" or not result then
  69. break
  70. end
  71. end
  72. rdBuf = unproc or ""
  73. end
  74. --读出
  75. local function read()
  76. local data = ""
  77. while true do
  78. data = uart.read(UART_ID,"*l")
  79. if not data or string.len(data) == 0 then break end
  80. --打开下面的打印会耗时
  81. --log.info("testUart.read bin",data)
  82. proc(data)
  83. end
  84. end
  85. --串口发送成功回调
  86. local function writeOk()
  87. log.info("autoGPS.writeOk")
  88. end
  89. --写判断查询版本号命令
  90. local function writeKindCmd()
  91. if string.len(gpsKind)==0 then
  92. writeCmd("$PDTINFO\r\n",true) --530H
  93. writeCmd("$PGKC462*") --530
  94. writeCmd("$PCAS06,0*") --530Z
  95. elseif gpsKind=="530Z" then writeCmd("$PCAS06,0*")
  96. elseif gpsKind=="530H" then writeCmd("$PDTINFO\r\n",true)
  97. elseif gpsKind=="530" then writeCmd("$PGKC462*")
  98. end
  99. end
  100. --波特率自动切换
  101. local function uartBaudrateTest()
  102. if string.len(gpsKind)==0 then
  103. uartBaudrate = uartBaudrate==115200 and 9600 or 115200
  104. uart.close(UART_ID)
  105. rdBuf = ""
  106. uart.setup(UART_ID,uartBaudrate,uartDatabits,uartParity,uartStopbits)
  107. log.info("autoGPS.uartBaudrateTest",uartBaudrate)
  108. end
  109. end
  110. local function init()
  111. --开始初始化
  112. if string.find(rtos.get_version(),"RDA8910") then
  113. pmd.ldoset(15,pmd.LDO_VIBR)
  114. else
  115. pmd.ldoset(7,pmd.LDO_VCAM)
  116. end
  117. rtos.sys32k_clk_out(1)
  118. --初始化完毕,开始注册回调打开串口
  119. uart.on(UART_ID,"sent",writeOk)
  120. uart.on(UART_ID,"receive",read)
  121. uart.setup(UART_ID,uartBaudrate,uartDatabits,uartParity,uartStopbits)
  122. end
  123. --解析关键字加载对应库
  124. local function loadLib(keyword)
  125. if keyword=="530" then
  126. gpsLib = require"gps"
  127. agpsLib = require"agps"
  128. elseif keyword=="530Z" then
  129. gpsLib = require"gpsZkw"
  130. agpsLib = require"agpsZkw"
  131. elseif keyword=="530H" then
  132. gpsLib = require"gpsHxxt"
  133. agpsLib = require"agpsHxxt"
  134. end
  135. if type(gpsLib)=="table" and type(gpsLib.init)=="fucntion" then
  136. gpsLib.init()
  137. end
  138. if type(agpsLib)=="table" and type(agpsLib.init)=="fucntion" then
  139. agpsLib.init()
  140. end
  141. end
  142. local function autoClose()
  143. uart.close(UART_ID)
  144. if string.find(rtos.get_version(),"RDA8910") then
  145. pmd.ldoset(0,pmd.LDO_VIBR)
  146. else
  147. pmd.ldoset(0,pmd.LDO_VCAM)
  148. end
  149. rtos.sys32k_clk_out(0)
  150. end
  151. local function selfAdapt()
  152. if io.exists(GPS_KIND_INFO_FILE) then
  153. local gpsKindInfo = io.readFile(GPS_KIND_INFO_FILE)
  154. log.info("autoGPS.task","gps kind info",gpsKindInfo)
  155. if string.find(gpsKindInfo,"530Z") then
  156. gpsKind="530Z"
  157. elseif string.find(gpsKindInfo,"530H") then
  158. gpsKind="530H"
  159. else
  160. gpsKind="530"
  161. end
  162. if string.find(gpsKindInfo,"9600") then
  163. uartBaudrate=9600
  164. elseif string.find(gpsKindInfo,"115200") then
  165. uartBaudrate=115200
  166. else
  167. log.warn("autoGPS.task","invalid uartBaudrate")
  168. end
  169. --从文件系统中读取有效内容后重载一次命令进行校验
  170. init()
  171. writeKindCmd()
  172. local result,data=sys.waitUntil("GPS_KIND",2000)
  173. if result then
  174. autoClose()
  175. loadLib(gpsKind)
  176. sys.publish("AUTOGPS_READY",gpsLib,agpsLib,gpsKind,uartBaudrate)
  177. rdBuf=""
  178. else
  179. log.warn("autoGPS.task","gps kind of history data err")
  180. sys.publish("GPS_WORK_ABNORMAL_IND")
  181. autoClose()
  182. return false
  183. end
  184. else
  185. rdBuf = ""
  186. init()
  187. while true do
  188. writeKindCmd()
  189. local result,data=sys.waitUntil("GPS_KIND",2000)
  190. if result then
  191. autoClose()
  192. loadLib(data)
  193. io.writeFile(GPS_KIND_INFO_FILE,gpsKind..tostring(uartBaudrate))
  194. sys.publish("AUTOGPS_READY",gpsLib,agpsLib,gpsKind,uartBaudrate)
  195. --rdBuf=nil
  196. rdBuf=""
  197. break
  198. else
  199. uartBaudrateTest()
  200. end
  201. sys.wait(100)
  202. end
  203. end
  204. end
  205. local coSelfAdapt = sys.taskInit(selfAdapt)
  206. --gps工作异常通知
  207. sys.subscribe("GPS_WORK_ABNORMAL_IND",function()
  208. log.info("autoGPS.GPS_WORK_ABNORMAL_IND",not coSelfAdapt or coroutine.status(coSelfAdapt)=="dead")
  209. if not coSelfAdapt or coroutine.status(coSelfAdapt)=="dead" then
  210. os.remove(GPS_KIND_INFO_FILE)
  211. if type(gpsLib)=="table" and type(gpsLib.unInit)=="function" then
  212. gpsLib.unInit()
  213. end
  214. if type(agpsLib)=="table" and type(agpsLib.unInit)=="function" then
  215. agpsLib.unInit()
  216. end
  217. gpsKind,gpsLib,agpsLib="","",""
  218. coSelfAdapt = sys.taskInit(selfAdapt)
  219. end
  220. end)