package drone import ( "fmt" "strconv" "strings" "github.com/vjeantet/jodaTime" ) type droneGPS struct { Time int64 // 위도 Latitude float64 // 경도 Longitude float64 // 고도 Altitude float32 // 속도 Speed int32 // 방향 Direction int16 // A or V Fixed string // LTE 통신 상태 LTEStatus string // EMM 오류 정보 EMMError string // ESM 오류 정보 ESMError string // 신호세기 SignalStrength int32 // 위성 갯수 SatelliteCount int32 // 위성 신호세기 ex) 17-44,19-43,6-42,28-41 SatelliteSignalStrength string } // fixed // 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, // $$GPS, 년월일, 시분초, 위도, 경도, 고도, 속도, 방향, A, LTE 통신 상태, EMM 오류 정보, ESM 오류 정보, 신호세기, 위성 갯수, 위성 ID-신호세기, 위성 ID-신호세기, 위성 ID-신호세기, 위성 ID-신호세기 // $$GPS,20190718,050519,37396586,126968913,798,0,0,A,2,255,255,-53,13,17-44,19-43,6-42,28-41 // unfixed // $$GPS,,,,,,,, V, LTE 통신 상태, EMM 오류 정보, ESM 오류 정보, 신호세기, 위성 갯수, 위성 ID-신호세기, 위성 ID-신호세기, 위성 ID-신호세기, 위성 ID-신호세기 // $$GPS,,,,,,,,V,2,255,255,-53,4,17-44,19-42,6-40,28-40 func parseProtocol(buf []byte) (*droneGPS, error) { data := string(buf) items := strings.Split(data, ",") gps := &droneGPS{ // A or V Fixed: items[8], // LTE 통신 상태 LTEStatus: items[9], // EMM 오류 정보 EMMError: items[10], // ESM 오류 정보 ESMError: items[11], } gps.SatelliteSignalStrength = strings.Join(items[12:], ",") signalStrength, err := strconv.ParseInt(items[12], 10, 32) if nil != err { return nil, err } gps.SignalStrength = int32(signalStrength) satelliteCount, err := strconv.ParseInt(items[13], 10, 32) if nil != err { return nil, err } gps.SatelliteCount = int32(satelliteCount) if "A" == gps.Fixed { dateTime, err := jodaTime.Parse("YYYYMMDDHHmmss", fmt.Sprintf("%s%s", items[1], items[2])) if nil != err { return nil, err } gps.Time = dateTime.Unix() latitude, err := strconv.ParseFloat(fmt.Sprintf("%s.%s", items[3][0:len(items[3])-6], items[3][len(items[3])-6:]), 64) if nil != err { return nil, err } gps.Latitude = latitude longitude, err := strconv.ParseFloat(fmt.Sprintf("%s.%s", items[4][0:len(items[4])-6], items[4][len(items[4])-6:]), 64) if nil != err { return nil, err } gps.Longitude = longitude altitude, err := strconv.ParseFloat(fmt.Sprintf("%s.%s", items[5][0:len(items[5])-1], items[5][len(items[5])-1:]), 32) if nil != err { return nil, err } gps.Altitude = float32(altitude) speed, err := strconv.ParseInt(items[6], 10, 32) if nil != err { return nil, err } gps.Speed = int32(speed) direction, err := strconv.ParseInt(items[7], 10, 16) if nil != err { return nil, err } gps.Direction = int16(direction) } return gps, nil }