[feature]
[添加日志、添加递归和递归上限]
This commit is contained in:
yangyakun
2023-06-20 19:07:32 +08:00
parent 6d93b6d229
commit 68d887299b

View File

@@ -6,6 +6,7 @@ import com.amap.api.maps.CoordinateConverter
import com.amap.api.maps.model.LatLng
import com.mogo.eagle.core.data.map.MogoLocation
import com.mogo.eagle.core.utilcode.mogo.logger.Logger
import com.mogo.eagle.core.utilcode.mogo.logger.scene.SceneConstant
import com.mogo.eagle.core.utilcode.util.CoordinateUtils
import com.mogo.eagle.core.utilcode.util.DrivingDirectionUtils
import com.mogo.och.common.module.manager.trajectorymamager.DistanceDegree
@@ -597,9 +598,12 @@ object CoordinateCalculateRouteUtil {
endIndex: Int,
mRoutePoints: List<MogoLocation>,
location: MogoLocation,
type:Int, //
size:Int = 8
type:Int,
size:Int = 4
): Triple<Int,Boolean?,Float> {
Logger.d(SceneConstant.M_OCHCOMMON + "calculateRouteSumLength",
"参数:[$preIndex $endIndex) mRoutePoints:${mRoutePoints.size} type:$type size:$size" +
" location:(${location.latitude},${location.longitude},${location.heading})")
var currentIndex:Int = preIndex //记录疑似点 //基础点
// 轨迹中的点和定位点的距离集合
val distanceMap: TreeMap<DistanceDegree, Int> = TreeMap()
@@ -710,6 +714,10 @@ object CoordinateCalculateRouteUtil {
}
}
if(distanceMap.size==0&&size<16){
return getNearestPointInfo(preIndex,endIndex,mRoutePoints,location,type,size+2)
}
// 最近点中包含上次计算的点和上次计算的最近的一个点
if(distanceMap.containsValue(preIndex)&&distanceMap.containsValue(preIndex+1)){
var preIndexDistance:DistanceDegree?=null