[VisualAngle]优化自车到终止线距离算法;道路事件场景切换逻辑

This commit is contained in:
renwj
2022-03-22 10:45:05 +08:00
parent f2307e6683
commit 8822d0865c
4 changed files with 45 additions and 35 deletions

View File

@@ -59,13 +59,7 @@ object CallerVisualAngleManager {
private var roadId = ""
override fun onRoadIdInfo(roadId: String) {}
override fun onStopLineInfo(info: StopLine) {
if (!hasCrossRoad && info.distanceOfCarToStopLine <= 30.0) {
hasCrossRoad = true
changeVisualAngle(CrossRoad)
}
override fun onRoadIdInfo(roadId: String) {
val oldRoadId = this.roadId
if (oldRoadId != roadId) {
if (hasCrossRoad) {
@@ -73,7 +67,14 @@ object CallerVisualAngleManager {
changeVisualAngle(Default())
}
}
this.roadId = info.roadId
this.roadId = roadId
}
override fun onStopLineInfo(info: StopLine) {
if (!hasCrossRoad && info.distanceOfCarToStopLine <= 30.0) {
hasCrossRoad = true
changeVisualAngle(CrossRoad)
}
}
})
}
@@ -177,10 +178,12 @@ object CallerVisualAngleManager {
@OptIn(InternalCoroutinesApi::class)
fun changeVisualAngle(scene: Scene) {
val triggerTime = TimeUnit.MILLISECONDS.toSeconds(SystemClock.elapsedRealtime())
val triggerTime = SystemClock.elapsedRealtime()
scope.launch {
Log.d("XXX", "--- 1 -----")
val displayed = getDisplayed()
if (displayed == null) {
Log.d("XXX", "--- 2 -----")
val top = getTop() //堆顶
if (top != null && top.target.priority > scene.priority) {
doChangeAngle(top)
@@ -190,27 +193,36 @@ object CallerVisualAngleManager {
}
Log.d(TAG, "没有正在展示的视角,当前要展示的视角: $scene")
} else {
if (scene.javaClass == displayed.javaClass) {
Log.d("XXX", "--- 3 -----")
if (scene.javaClass == displayed.target.javaClass) {
Log.d("XXX", "--- 4 -----")
Log.d(TAG, "同一种场景不需要重复展示")
defaultDelayJob?.safeCancel()
return@launch
}
if (scene is Default) {
Log.d("XXX", "--- 5 -----")
Log.d(TAG, "恢复到默认视图,之前展示的视图:$displayed")
heap -= displayed
defaultDelayJob?.safeCancel()
launch {
val delay = scene.unit.toMillis(scene.delay)
Log.d(TAG, "默认视图开启延时倒计时, 倒计时时间:${delay} ms.")
delay(delay)
Log.d(TAG, "默认视图结束倒计时,开始展示...")
doChangeAngle(Record(scene, triggerTime = triggerTime))
heap -= displayed
}.also { defaultDelayJob = it }
} else {
Log.d("XXX", "--- 6 -----")
defaultDelayJob?.safeCancel()
val delta = triggerTime - displayed.triggerTime
if (delta >= MaxDisplayThreshold) {
Log.d("XXX", "--- 6-1 -----")
Log.d(TAG, "场景: $scene 触发展示,满足条件开始展示...")
doChangeAngle(Record(scene, triggerTime = triggerTime))
} else {
Log.d(TAG, "场景: $scene 触发展示但是在20s内丢弃...")
Log.d("XXX", "--- 6-2 -----")
Log.d(TAG, "场景: $scene 触发展示但是在30s内丢弃...")
}
}
}
@@ -220,14 +232,13 @@ object CallerVisualAngleManager {
@OptIn(InternalCoroutinesApi::class)
private fun doChangeAngle(record: Record) {
CallerMapUIServiceManager.getMapUIController()?.also {
record.isDisplay = true
synchronized(heap) {
heap += record
if (record.target !is Default) {
record.isDisplay = true
synchronized(heap) {
heap += record
}
}
val target = record.target
if (target !is Default) {
defaultDelayJob?.safeCancel()
}
if (target is LowSpeed) {
it.changeMapVisualAngle(record.target.angle, MogoLatLng(target.lat, target.lon))
} else {