import uos, quecgnss, time, modem
from machine import UART

import uos, modem
print('IMEI:            {}'.format(modem.getDevImei()))
print('FwVersion:       {}'.format(modem.getDevFwVersion()))
print('SDKVersion:      {}'.format(uos.sdkver()))
print('DetailedVersio:  {}'.format(uos.uname2()))

uart = UART(UART.UART2, 115200, 8, 0, 1, 0)

def main():
    global uart
    # 1. GNSS配置初始化
    # quecgnss.configSet(0, 7)  # BeiDou 
    # quecgnss.configSet(0, 1)  # GPS+BeiDou 
    quecgnss.configSet(0, 5)  # GPS+BeiDou+Galileo 
    if quecgnss.configSet(1, 127) != 0:  # 部分模块不支持GST语句. 
        quecgnss.configSet(1, 63)  # 配置nmea输出类型 
    quecgnss.configSet(2, 1)  # AGPS
    quecgnss.configSet(3, 0)  # APFLASH, 模块断电重启会导致APFlash丢失. 
    quecgnss.configSet(4, 0)  # 备用电源, 800K不带备电. 
    QuecGnssInfo = None
    QuecGnssInfo = quecgnss.configGet(0)
    if QuecGnssInfo == 0:
        print("当前卫星系统: GPS")
    elif QuecGnssInfo == 1:
        print("当前卫星系统: GPS+BeiDou")
    elif QuecGnssInfo == 3:
        print("当前卫星系统: GPS+GLONASS+Galileo")
    elif QuecGnssInfo == 4:
        print("当前卫星系统: GPS+GLONASS")
    elif QuecGnssInfo == 5:
        print("当前卫星系统: GPS+BeiDou+Galileo")
    elif QuecGnssInfo == 6:
        print("当前卫星系统: GPS+Galileo")
    elif QuecGnssInfo == 7:
        print("当前卫星系统: BeiDou")
    else: 
        print("当前卫星系统: 未知")
    # NMEA语句类型(实际上是二进制表示的6位bitMap): 
    # 0   禁止输出NMEA语句
    # 1   GGA
    # 2   RMC
    # 8   GSA
    # 16  VTG
    # 32  GLL
    # 63  输出以上所有类型的语句
    # 64  GST
    # 127 输出以上所有类型的语句
    # GNSS 初始化后无法动态调整, 必须重启模组. 
    QuecGnssInfo = None
    QuecGnssInfo = quecgnss.configGet(1)
    print("当前NMEA状态: {}".format(QuecGnssInfo))
    QuecGnssInfo = None
    QuecGnssInfo = quecgnss.configGet(2)
    print("当前APGS状态: {}".format(QuecGnssInfo))
    QuecGnssInfo = None
    QuecGnssInfo = quecgnss.configGet(3)
    print("当前APFlash状态: {}".format(QuecGnssInfo))
    QuecGnssInfo = None
    QuecGnssInfo = quecgnss.configGet(4)
    print("当前备电状态: {}".format(QuecGnssInfo))
    # 2. 初始化GNSS模块
    ret = quecgnss.init()
    if ret == 0:
        print('GNSS init ok.')
    else:
        print('GNSS init failed.')
        return -1
    print('GNSS初始化成功，开始输出定位信息...\r\n')
    try:
        while True:
            # 3. 读取GNSS数据
            data = quecgnss.read(4096)
            if data and len(data) >= 2:
                # 4. 解码并打印NMEA数据
                try:
                    nmea_data = data[1].decode('utf-8').strip()
                    if nmea_data:
                        print("{}\r\n".format(nmea_data))
                        uart.write("{}".format(nmea_data))
                except UnicodeDecodeError:
                    print("数据解码错误，接收原始数据:", data[1])
            # 5. 控制输出频率
            time.sleep(1)
    except KeyboardInterrupt:
        print("用户中断，正在关闭GNSS...")
    finally:
        # 6. 确保GNSS被正确关闭
        quecgnss.configSet(2, 0)  # AGPS 
        quecgnss.configSet(3, 0)  # APFLASH, 模块断电重启会导致APFlash丢失. 
        quecgnss.configSet(4, 0)  # 备用电源, 800K不带备电. 
        quecgnss.gnssEnable(0)
        print("GNSS已安全关闭")

if __name__ == '__main__':
    main()
