| | |
| | | |
| | | import com.flightfeather.uav.lightshare.bean.CompanySOP |
| | | import com.flightfeather.uav.lightshare.bean.DataVo |
| | | import com.flightfeather.uav.model.BaseSOP |
| | | import com.flightfeather.uav.model.BaseWeight |
| | | import com.flightfeather.uav.socket.eunm.FactorType |
| | | import kotlin.math.PI |
| | |
| | | /** |
| | | * 风向权重 |
| | | */ |
| | | class WindDirWeight(var defaultLocation: Pair<Double, Double>?) : BaseWeight<DataVo, CompanySOP>() { |
| | | class WindDirWeight(var defaultLocation: Pair<Double, Double>?) : BaseWeight<DataVo, BaseSOP>() { |
| | | |
| | | override val tag: String = "风向权重" |
| | | |
| | |
| | | |
| | | override val weights: List<Double> = listOf(1.0, 0.8, 0.5, 0.2, 0.1) |
| | | |
| | | override fun onWeightFactor(mData: DataVo, sop: CompanySOP): Double { |
| | | override fun onWeightFactor(mData: DataVo, sop: BaseSOP): Double { |
| | | val p1 = if (mData.lng == null || mData.lat == null || mData.lng == .0 || mData.lat == .0) defaultLocation else Pair(mData.lng!!, mData.lat!!) |
| | | p1 ?: return .0 |
| | | val p2 = Pair(sop.ciLongitude!!.toDouble(), sop.ciLatitude!!.toDouble()) |
| | |
| | | private fun getAngle(p1: Pair<Double, Double>, p2: Pair<Double, Double>, wd: Double): Double { |
| | | val dx = p2.first - p1.first |
| | | val dy = p2.second - p1.second |
| | | var x1 = atan2(dy, dx) * 180 / PI |
| | | var x1 = atan2(dy, dx) * 180 / PI + 180 |
| | | if (x1 < 0) x1 += 360 |
| | | var x2 = 270 - wd |
| | | if (x2 < 0) x2 += 360 |