| | | 1 | | using System.Collections; |
| | | 2 | | using System.Collections.Generic; |
| | | 3 | | using UnityEngine; |
| | | 4 | | |
| | | 5 | | public abstract class Threat : Agent { |
| | | 6 | | protected AttackBehavior _attackBehavior; |
| | | 7 | | [SerializeField] |
| | | 8 | | protected Vector3 _currentWaypoint; |
| | | 9 | | [SerializeField] |
| | | 10 | | protected PowerSetting _currentPowerSetting; |
| | | 11 | | |
| | | 12 | | protected SensorOutput _sensorOutput; |
| | | 13 | | protected Sensor _sensor; |
| | | 14 | | |
| | 0 | 15 | | protected override void Awake() { |
| | 0 | 16 | | base.Awake(); |
| | 0 | 17 | | SetFlightPhase(FlightPhase.INITIALIZED); |
| | 0 | 18 | | } |
| | | 19 | | |
| | 15 | 20 | | public void SetAttackBehavior(AttackBehavior attackBehavior) { |
| | 15 | 21 | | _attackBehavior = attackBehavior; |
| | 15 | 22 | | _target = SimManager.Instance.CreateDummyAgent(attackBehavior.targetPosition, |
| | | 23 | | attackBehavior.targetVelocity); |
| | 15 | 24 | | } |
| | | 25 | | |
| | 4 | 26 | | protected float PowerTableLookup(PowerSetting powerSetting) { |
| | 4 | 27 | | switch (powerSetting) { |
| | | 28 | | case PowerSetting.IDLE: |
| | 2 | 29 | | return staticAgentConfig.powerTable.IDLE; |
| | | 30 | | case PowerSetting.LOW: |
| | 0 | 31 | | return staticAgentConfig.powerTable.LOW; |
| | | 32 | | case PowerSetting.CRUISE: |
| | 0 | 33 | | return staticAgentConfig.powerTable.CRUISE; |
| | | 34 | | case PowerSetting.MIL: |
| | 2 | 35 | | return staticAgentConfig.powerTable.MIL; |
| | | 36 | | case PowerSetting.MAX: |
| | 0 | 37 | | return staticAgentConfig.powerTable.MAX; |
| | | 38 | | default: |
| | 0 | 39 | | Debug.LogError("Invalid power setting."); |
| | 0 | 40 | | return 0f; |
| | | 41 | | } |
| | 4 | 42 | | } |
| | | 43 | | |
| | 2 | 44 | | public override bool IsAssignable() { |
| | 2 | 45 | | return false; |
| | 2 | 46 | | } |
| | | 47 | | |
| | 15 | 48 | | protected override void Start() { |
| | 15 | 49 | | base.Start(); |
| | 15 | 50 | | _sensor = GetComponent<Sensor>(); |
| | 15 | 51 | | } |
| | | 52 | | |
| | 0 | 53 | | protected override void FixedUpdate() { |
| | 0 | 54 | | base.FixedUpdate(); |
| | 0 | 55 | | } |
| | | 56 | | |
| | 0 | 57 | | protected Vector3 CalculateForwardAcceleration() { |
| | 0 | 58 | | Vector3 transformVelocity = GetVelocity(); |
| | | 59 | | |
| | | 60 | | // Get the target speed for the current power setting. |
| | 0 | 61 | | float targetSpeed = PowerTableLookup(_currentPowerSetting); |
| | | 62 | | |
| | | 63 | | // Calculate the current speed. |
| | 0 | 64 | | float currentSpeed = transformVelocity.magnitude; |
| | | 65 | | |
| | | 66 | | // Speed error. |
| | 0 | 67 | | float speedError = targetSpeed - currentSpeed; |
| | | 68 | | |
| | | 69 | | // Proportional gain for speed control. |
| | 0 | 70 | | float speedControlGain = 10.0f; // Adjust this gain as necessary. |
| | | 71 | | |
| | | 72 | | // Desired acceleration to adjust speed. |
| | 0 | 73 | | float desiredAccelerationMagnitude = speedControlGain * speedError; |
| | | 74 | | |
| | | 75 | | // Limit the desired acceleration. |
| | 0 | 76 | | float maxForwardAcceleration = CalculateMaxForwardAcceleration(); |
| | 0 | 77 | | desiredAccelerationMagnitude = |
| | | 78 | | Mathf.Clamp(desiredAccelerationMagnitude, -maxForwardAcceleration, maxForwardAcceleration); |
| | | 79 | | |
| | | 80 | | // Acceleration direction (along current velocity direction). |
| | 0 | 81 | | Vector3 accelerationDirection = transformVelocity.normalized; |
| | | 82 | | |
| | | 83 | | // Handle the zero velocity case. |
| | 0 | 84 | | if (accelerationDirection.magnitude < 0.1f) { |
| | 0 | 85 | | accelerationDirection = transform.forward; // Default direction. |
| | 0 | 86 | | } |
| | | 87 | | |
| | | 88 | | // Calculate the acceleration vector. |
| | 0 | 89 | | Vector3 speedAdjustmentAcceleration = accelerationDirection * desiredAccelerationMagnitude; |
| | 0 | 90 | | return speedAdjustmentAcceleration; |
| | 0 | 91 | | } |
| | | 92 | | |
| | 0 | 93 | | protected Agent GetClosestInterceptor() { |
| | 0 | 94 | | if (_interceptors.Count == 0) { |
| | 0 | 95 | | return null; |
| | | 96 | | } |
| | | 97 | | |
| | 0 | 98 | | Agent closestInterceptor = null; |
| | 0 | 99 | | float minDistance = float.MaxValue; |
| | 0 | 100 | | foreach (var interceptor in _interceptors) { |
| | 0 | 101 | | if (!interceptor.HasTerminated()) { |
| | 0 | 102 | | SensorOutput sensorOutput = _sensor.Sense(interceptor); |
| | 0 | 103 | | if (sensorOutput.position.range < minDistance) { |
| | 0 | 104 | | closestInterceptor = interceptor; |
| | 0 | 105 | | minDistance = sensorOutput.position.range; |
| | 0 | 106 | | } |
| | 0 | 107 | | } |
| | 0 | 108 | | } |
| | 0 | 109 | | return closestInterceptor; |
| | 0 | 110 | | } |
| | | 111 | | |
| | 0 | 112 | | protected bool ShouldEvade() { |
| | 0 | 113 | | if (!dynamicAgentConfig.dynamic_config.flight_config.evasionEnabled) { |
| | 0 | 114 | | return false; |
| | | 115 | | } |
| | | 116 | | |
| | 0 | 117 | | Agent closestInterceptor = GetClosestInterceptor(); |
| | 0 | 118 | | if (closestInterceptor == null) { |
| | 0 | 119 | | return false; |
| | | 120 | | } |
| | | 121 | | |
| | 0 | 122 | | float evasionRangeThreshold = |
| | | 123 | | dynamicAgentConfig.dynamic_config.flight_config.evasionRangeThreshold; |
| | 0 | 124 | | SensorOutput sensorOutput = _sensor.Sense(closestInterceptor); |
| | 0 | 125 | | return sensorOutput.position.range <= evasionRangeThreshold && sensorOutput.velocity.range < 0; |
| | 0 | 126 | | } |
| | | 127 | | |
| | 0 | 128 | | protected Vector3 EvadeInterceptor(Agent interceptor) { |
| | 0 | 129 | | Vector3 transformVelocity = GetVelocity(); |
| | 0 | 130 | | Vector3 interceptorVelocity = interceptor.GetVelocity(); |
| | 0 | 131 | | Vector3 transformPosition = GetPosition(); |
| | 0 | 132 | | Vector3 interceptorPosition = interceptor.GetPosition(); |
| | | 133 | | |
| | | 134 | | // Set power setting to maximum. |
| | 0 | 135 | | _currentPowerSetting = PowerSetting.MAX; |
| | | 136 | | |
| | | 137 | | // Evade the interceptor by changing the velocity to be normal to the interceptor's velocity. |
| | 0 | 138 | | Vector3 normalVelocity = Vector3.ProjectOnPlane(transformVelocity, interceptorVelocity); |
| | 0 | 139 | | Vector3 normalAccelerationDirection = |
| | | 140 | | Vector3.ProjectOnPlane(normalVelocity, transformVelocity).normalized; |
| | | 141 | | |
| | | 142 | | // Turn away from the interceptor. |
| | 0 | 143 | | Vector3 relativePosition = interceptorPosition - transformPosition; |
| | 0 | 144 | | if (Vector3.Dot(relativePosition, normalAccelerationDirection) > 0) { |
| | 0 | 145 | | normalAccelerationDirection *= -1; |
| | 0 | 146 | | } |
| | | 147 | | |
| | | 148 | | // Avoid evading straight down when near the ground. |
| | 0 | 149 | | float altitude = transformPosition.y; |
| | 0 | 150 | | float groundProximityThreshold = |
| | | 151 | | Mathf.Abs(transformVelocity.y) * 5f; // Adjust threshold as necessary. |
| | 0 | 152 | | if (transformVelocity.y < 0 && altitude < groundProximityThreshold) { |
| | | 153 | | // Determine evasion direction based on angle to interceptor. |
| | 0 | 154 | | Vector3 toInterceptor = interceptorPosition - transformPosition; |
| | 0 | 155 | | Vector3 rightDirection = Vector3.Cross(Vector3.up, transform.forward); |
| | 0 | 156 | | float angle = Vector3.SignedAngle(transform.forward, toInterceptor, Vector3.up); |
| | | 157 | | |
| | | 158 | | // Choose the direction that leads away from the interceptor. |
| | 0 | 159 | | Vector3 bestHorizontalDirection = angle > 0 ? -rightDirection : rightDirection; |
| | | 160 | | |
| | | 161 | | // Blend between horizontal evasion and slight upward movement. |
| | 0 | 162 | | float blendFactor = 1 - (altitude / groundProximityThreshold); |
| | 0 | 163 | | normalAccelerationDirection = |
| | | 164 | | Vector3 |
| | | 165 | | .Lerp(normalAccelerationDirection, bestHorizontalDirection + transform.up * 5f, |
| | | 166 | | blendFactor) |
| | | 167 | | .normalized; |
| | 0 | 168 | | } |
| | 0 | 169 | | Vector3 normalAcceleration = normalAccelerationDirection * CalculateMaxNormalAcceleration(); |
| | | 170 | | |
| | | 171 | | // Adjust the forward speed. |
| | 0 | 172 | | Vector3 forwardAcceleration = CalculateForwardAcceleration(); |
| | | 173 | | |
| | 0 | 174 | | return normalAcceleration + forwardAcceleration; |
| | 0 | 175 | | } |
| | | 176 | | |
| | 0 | 177 | | private void OnTriggerEnter(Collider other) { |
| | | 178 | | // Check if the threat hit the floor with a negative vertical speed. |
| | 0 | 179 | | if (other.gameObject.name == "Floor" && Vector3.Dot(GetVelocity(), Vector3.up) < 0) { |
| | 0 | 180 | | HandleHitGround(); |
| | 0 | 181 | | } |
| | | 182 | | |
| | | 183 | | // Check if the collision is with the asset. |
| | 0 | 184 | | DummyAgent otherAgent = other.gameObject.GetComponentInParent<DummyAgent>(); |
| | 0 | 185 | | if (otherAgent != null && _target == otherAgent) { |
| | 0 | 186 | | HandleThreatHit(); |
| | 0 | 187 | | } |
| | 0 | 188 | | } |
| | | 189 | | } |