[2.13.0-arch-opt] locationUtil move

foudations/mogo-commons/src/main/java/com/mogo/commons/utils/LocationUtils.java

@@ -0,0 +1,44 @@
+package com.mogo.commons.utils;
+
+import static com.mogo.eagle.core.utilcode.mogo.logger.scene.SceneConstant.M_V2X;
+
+import com.mogo.eagle.core.data.map.MogoLatLng;
+import com.mogo.eagle.core.data.map.MogoLocation;
+import com.mogo.eagle.core.utilcode.mogo.logger.CallerLogger;
+import com.mogo.eagle.core.utilcode.util.DrivingDirectionUtils;
+
+/**
+ * author : donghongyu
+ * e-mail : 1358506549@qq.com
+ * date   : 2020/5/15 10:31 AM
+ * desc   : 基于位置工具类
+ * version: 1.0
+ */
+public class LocationUtils {
+    private static final String TAG = "LocationUtils";
+
+    /**
+     * 获取传入的经纬度在车辆的什么位置
+     *
+     * @return 顺时针，true-前，false-后
+     */
+    public static boolean isPointOnCarFront(MogoLocation carLocal, MogoLatLng pointLocal) {
+        double carLon = carLocal.getLongitude();
+        double carLat = carLocal.getLatitude();
+        double poiLon = pointLocal.getLon();
+        double poiLat = pointLocal.getLat();
+        float carAngle = carLocal.getBearing();
+
+        // 计算车辆与点之间的夹角
+        int diffAngle = DrivingDirectionUtils.getDegreeOfCar2Poi(
+                carLon, carLat, poiLon, poiLat, (int) carAngle);
+
+        if (diffAngle <= 90) {
+            CallerLogger.INSTANCE.i(M_V2X + TAG, "目标点在车辆--前方");
+            return true;
+        } else {
+            CallerLogger.INSTANCE.i(M_V2X + TAG, "目标点在车辆--后方");
+            return false;
+        }
+    }
+}