完成识别元素绘制逻辑替换

Signed-off-by: 董宏宇 <martindhy@gmail.com>
2021-10-19 15:14:52 +08:00
parent de0a9c0c0b
commit 8d784b4014
8 changed files with 275 additions and 25 deletions
--- a/modules/mogo-module-common/src/main/java/com/mogo/module/common/drawer/AdasRecognizedResultDrawer.java
+++ b/modules/mogo-module-common/src/main/java/com/mogo/module/common/drawer/AdasRecognizedResultDrawer.java
@@ -31,7 +31,7 @@ import java.util.concurrent.TimeUnit;
 */
 public class AdasRecognizedResultDrawer extends BaseDrawer {

-    private static final String TAG = "RecognizedResultDrawer";
+    private static final String TAG = "AdasRecognizedResultDrawer";

    private static volatile AdasRecognizedResultDrawer sInstance;

--- a/modules/mogo-module-common/src/main/java/com/mogo/module/common/drawer/IdentifyDataDrawer.java
+++ b/modules/mogo-module-common/src/main/java/com/mogo/module/common/drawer/IdentifyDataDrawer.java
@@ -0,0 +1,252 @@
+package com.mogo.module.common.drawer;
+
+import static com.mogo.cloud.socket.entity.SocketDownDataHelper.FROM_ADAS;
+
+import android.text.TextUtils;
+import android.util.Log;
+
+import com.mogo.commons.debug.DebugConfig;
+import com.mogo.eagle.core.data.map.MogoLatLng;
+import com.mogo.eagle.core.data.traffic.TrafficData;
+import com.mogo.map.marker.IMogoMarker;
+import com.mogo.map.marker.MogoMarkerOptions;
+import com.mogo.module.common.MogoApisHandler;
+import com.mogo.module.common.constants.DataTypes;
+
+import java.util.ArrayList;
+import java.util.Iterator;
+import java.util.List;
+import java.util.Map;
+import java.util.concurrent.ConcurrentHashMap;
+import java.util.concurrent.TimeUnit;
+
+/**
+ * @author xiaoyuzhou
+ * @date 2021/10/19 10:45 上午
+ * 域控制器识别信息绘制
+ */
+public class IdentifyDataDrawer extends BaseDrawer {
+
+    private static final String TAG = "IdentifyDataDrawer";
+
+    private static volatile IdentifyDataDrawer sInstance;
+
+    /**
+     * 上一帧数据的缓存
+     */
+    private static Map<String, IMogoMarker> mMarkersCaches = new ConcurrentHashMap<>();
+
+    public IdentifyDataDrawer() {
+        super();
+    }
+
+    private final Map<String, TrafficData> mLastPositions = new ConcurrentHashMap<>();
+
+    public static IdentifyDataDrawer getInstance() {
+        if (sInstance == null) {
+            synchronized (IdentifyDataDrawer.class) {
+                if (sInstance == null) {
+                    sInstance = new IdentifyDataDrawer();
+                }
+            }
+        }
+        return sInstance;
+    }
+
+    public synchronized void release() {
+        sInstance = null;
+    }
+
+    /**
+     * 渲染 adas 识别的数据
+     *
+     * @param resultList adas感知融合数据
+     */
+    public void renderAdasRecognizedResult(List<TrafficData> resultList) {
+
+        final long start = System.nanoTime();
+        if (resultList == null || resultList.isEmpty() || !DebugConfig.isUseAdasRecognize()) {
+            clearOldMarker();
+            Log.w("ADAS数据延时绘制", "resultList==>" + resultList + "  DebugConfig.isUseAdasRecognize()==>" + DebugConfig.isUseAdasRecognize());
+            return;
+        }
+
+        if (!MogoApisHandler.getInstance().getApis().getStatusManagerApi().isVrMode()) {
+            clearOldMarker();
+            Log.w("ADAS数据延时绘制", "当前不是VR模式");
+            return;
+        }
+
+
+        Map<String, IMogoMarker> newAdasRecognizedMarkersCaches = new ConcurrentHashMap<>();
+        List<TrafficData> newDiffSet = new ArrayList<>();
+        for (TrafficData recognizedListResult : resultList) {
+
+            if (isUselessValue(recognizedListResult)) {
+                continue;
+            }
+            // 复用之前存在的 marker
+            String uniqueKey = recognizedListResult.getUuid();
+            IMogoMarker marker = mMarkersCaches.remove(uniqueKey);
+            if (marker != null && !marker.isDestroyed()) {
+//                Log.d(TAG, "发现缓存marker id : " + uniqueKey);
+                updateCacheMarkerRes(marker, recognizedListResult);
+                renderAdasOneFrame(marker, uniqueKey, recognizedListResult, newAdasRecognizedMarkersCaches);
+            } else {
+                // 新增添加进差集
+                newDiffSet.add(recognizedListResult);
+            }
+        }
+        removeUselessMarker(mMarkersCaches);
+        removeUselessLastRecord();
+        int newDiffSetSize = newDiffSet.size();
+//        Log.d(TAG, "原数据量 ： " + resultList.size() + "  新增marker数量 ： " + newDiffSetSize);
+        // 复用过期 marker
+        if (newDiffSetSize > 0) {
+            for (int i = 0; i < newDiffSetSize; i++) {
+                TrafficData recognizedListResult = newDiffSet.get(i);
+                String uniqueKey = recognizedListResult.getUuid();
+                IMogoMarker marker = drawAdasRecognizedDataMarker(recognizedListResult);
+                if (marker == null) {
+                    continue;
+                }
+//                Log.d(TAG, "新增marker id : " + uniqueKey);
+                renderAdasOneFrame(marker, uniqueKey, recognizedListResult, newAdasRecognizedMarkersCaches);
+            }
+        }
+        sendMessage(MSG_REMOVE_DIRTY_MARKERS, mMarkersCaches);
+        mMarkersCaches.clear();
+        mMarkersCaches = newAdasRecognizedMarkersCaches;
+        Log.d("ADAS数据延时绘制", "render 接收数据 -> 处理结束 " + TimeUnit.NANOSECONDS.toMillis((System.nanoTime() - start)) + "ms");
+    }
+
+    /**
+     * todo 后面涉及到此类变化的数据均改动
+     *
+     * @param marker
+     * @param recognizedListResult
+     */
+    private void updateCacheMarkerRes(IMogoMarker marker, TrafficData recognizedListResult) {
+        String resIdVal;
+        int resId = getModelRes(recognizedListResult.getType().getType());
+        resIdVal = resId + "";
+        String resName = mMarkerCachesResMd5Values.get(resIdVal);
+        if (!TextUtils.isEmpty(resName)) {
+            if (!TextUtils.equals(resName, marker.getMarkerResName())) {
+                marker.use3DResource(resName);
+            }
+        } else {
+            resName = marker.use3DResource(resId);
+            mMarkerCachesResMd5Values.put(resIdVal, resName);
+        }
+    }
+
+    private void removeUselessLastRecord() {  // todo 最好重新设计一个数据结构，用于多线程数据过期失效的场景，参见redis数据过期
+        if (mLastPositions.isEmpty()) {
+            return;
+        }
+        Iterator<TrafficData> iterator = mLastPositions.values().iterator();
+        Log.d("EmArrow", "removeUselessLastRecord size : " + mLastPositions.size());
+        while (iterator.hasNext()) {
+            TrafficData result = iterator.next();
+            long internal = result.getSatelliteTime() - getCurSatelliteTime();
+            if (internal > 3000) { //防止帧率过低导致误删除上一个节点对象，从而出现跳跃现象
+                iterator.remove();
+            }
+        }
+    }
+
+    /**
+     * 过滤无用数据
+     *
+     * @param recognizedListResult {@link TrafficData}
+     * @return useless
+     */
+    private boolean isUselessValue(TrafficData recognizedListResult) {
+        if (recognizedListResult == null) {
+            return true;
+        }
+        if (nonRenderType(recognizedListResult.getType().getType())) {
+            return true;
+        }
+        String uniqueKey = recognizedListResult.getUuid();
+        return TextUtils.isEmpty(uniqueKey);
+    }
+
+    /**
+     * 绘制某个物体的一个数据
+     *
+     * @param recognizedListResult           {@link TrafficData}
+     * @param newAdasRecognizedMarkersCaches 缓存集合
+     */
+    private void renderAdasOneFrame(IMogoMarker marker,
+                                    String uniqueKey,
+                                    TrafficData recognizedListResult,
+                                    Map<String, IMogoMarker> newAdasRecognizedMarkersCaches) {
+        final long start = System.nanoTime();
+//        Log.d(TAG, "renderAdasOneFrame uuid :  " + uniqueKey + "  type : " + recognizedListResult.type + " heading : " + recognizedListResult.heading);
+        TrafficData lastPosition = mLastPositions.remove(uniqueKey);
+
+        mLastPositions.put(uniqueKey, recognizedListResult);
+//        Log.d(TAG, "使用缓存 id : " + uniqueKey);
+        long interval = 45;
+        if (lastPosition != null) {
+            interval = computeAnimDuration(lastPosition.getSatelliteTime(), recognizedListResult.getSatelliteTime());
+        }
+        final MogoLatLng renderLoc = new MogoLatLng(recognizedListResult.getLat(), recognizedListResult.getLon());
+        long cost = TimeUnit.NANOSECONDS.toMillis(System.nanoTime() - start);
+        Log.d("ADAS动画数据", "cost : " + cost);
+        final long intervalRef = interval - cost;
+        Log.d("ADAS动画数据", "最终赋值 : " + intervalRef + "  两帧间隔 : " + interval + "  uuid : " + recognizedListResult.getUuid());
+        marker.addDynamicAnchorPosition(renderLoc, (float) recognizedListResult.getHeading(), intervalRef);
+        String carColor = getModelRenderColor(recognizedListResult.getType().getType(), FROM_ADAS, recognizedListResult.getThreatLevel());
+        marker.setAnchorColor(carColor);
+
+        newAdasRecognizedMarkersCaches.put(uniqueKey, marker);
+        Log.d("ADAS数据延时", "render 刷新一台车 cost : " + TimeUnit.NANOSECONDS.toMillis((System.nanoTime() - start)));
+    }
+
+    /**
+     * 绘制 marker
+     *
+     * @param recognizedListResult {@link TrafficData}
+     * @return {@link IMogoMarker}
+     */
+    private IMogoMarker drawAdasRecognizedDataMarker(TrafficData recognizedListResult) {
+        long start = System.nanoTime();
+        if (recognizedListResult == null) {
+            return null;
+        }
+
+        int resId = getModelRes(recognizedListResult.getType().getType());
+        String resIdVal = resId + "";
+
+        String carColor = getModelRenderColor(recognizedListResult.getType().getType(), FROM_ADAS, recognizedListResult.getThreatLevel());
+        MogoMarkerOptions options = new MogoMarkerOptions()
+                .owner(DataTypes.TYPE_MARKER_ADAS)
+                .anchor(0.5f, 0.5f)
+                .set3DMode(true)
+                .gps(true)
+                .anchorColor(carColor)
+                .controlAngle(true)
+                .resName(mMarkerCachesResMd5Values.get(resIdVal))
+                .icon3DRes(resId)
+                .rotate((float) recognizedListResult.getHeading())
+                .position(new MogoLatLng(recognizedListResult.getLat(), recognizedListResult.getLon()));
+        IMogoMarker marker = MogoApisHandler.getInstance().getApis().getMapServiceApi().getMarkerManager(mContext).addMarker(DataTypes.TYPE_MARKER_ADAS, options);
+        cacheMarkerIconResMd5Val(resIdVal, marker);
+        Log.d("ADAS数据延时", "创建一个新 marker cost : " + TimeUnit.NANOSECONDS.toMillis((System.nanoTime() - start)));
+        return marker;
+    }
+
+    /**
+     * 清除旧的 marker 数据
+     */
+    public void clearOldMarker() {
+        if (mMarkersCaches != null) {
+            mMarkersCaches.clear();
+        }
+        mLastPositions.clear();
+        sendMessage(MSG_REMOVE_DIRTY_MARKERS, DataTypes.TYPE_MARKER_ADAS);
+    }
+}