add skip time for BBL

stronnag · Aug 23, 2024 · 8957a84 · 8957a84
1 parent 89b5311
commit 8957a84
Show file tree

Hide file tree

Showing 2 changed files with 12 additions and 0 deletions.
diff --git a/pkg/bbl/bblreader.go b/pkg/bbl/bblreader.go
@@ -735,6 +735,11 @@ func (lg *BBLOG) Reader(meta types.FlightMeta, ch chan interface{}) (types.LogSe
 	leffic := 0.0
 	lwhkm := 0.0
 	whacc := 0.0
+	var skiptime uint64 = 0
+
+	if options.Config.SkipTime > 0 {
+		skiptime = uint64(options.Config.SkipTime) * 1000
+	}
 
 	for i := 0; ; i++ {
 		record, err := r.Read()
@@ -793,6 +798,11 @@ func (lg *BBLOG) Reader(meta types.FlightMeta, ch chan interface{}) (types.LogSe
 			}
 		} else {
 			us := b.Stamp
+			var deltat = us - st
+			if skiptime > 0 && deltat < skiptime {
+				continue
+			}
+
 			if us > st {
 				var d float64
 				var c float64

diff --git a/pkg/options/options.go b/pkg/options/options.go
@@ -60,6 +60,7 @@ type Configuration struct {
 	Verbose         int     `json:"-"`
 	SitlConfig      string  `json:"-"`
 	SitlMinimal     bool    `json:"-"`
+	SkipTime        int     `json:"-"`
 }
 
 var Config Configuration = Configuration{Intvl: 1000, Blackbox_decode: "blackbox_decode", Bulletvers: 2, SplitTime: 120, Epsilon: 0.015, StartOff: 30, EndOff: -30, Engunit: "mah", MaxWP: 120}
@@ -161,6 +162,7 @@ func ParseCLI(gv func() string) ([]string, string) {
 		flag.BoolVar(&Config.Metas, "metas", false, "list metadata and exit")
 		flag.BoolVar(&Config.Fast, "fast", false, "faster replay")
 		flag.IntVar(&Config.Type, "type", Config.Type, "model type")
+		flag.IntVar(&Config.SkipTime, "skiptime", Config.SkipTime, "[BBL] Skip Time (ms)")
 	} else if strings.HasPrefix(app, "log2mission") {
 		flag.Float64Var(&Config.Epsilon, "epsilon", Config.Epsilon, "Epsilon")
 		flag.IntVar(&Config.StartOff, "start-offset", Config.StartOff, "Start Offset (seconds)")