Unity3D中的弹道和移动目标提前量计算

弹道计算是游戏里常见的问题，其中关于击中移动目标的自动计算提前量的话题，看似简单，其实还是挺复杂的数学。网上这方面的资料还真不多，而且都是写的含含糊糊。抽空总结一下自己的方法。

讨论的前提是，假设目标是在3D空间里以匀速直线方式运动。

1.直线弹道
在不考虑重力和空气阻力影响的情况下，子弹的弹道呈直线运动。这种情况下，其实是个纯平面几何空间的问题，不需要微积分和线代知识。
分析的情况如下图:

图片：tj-1.jpg

虽然在3D空间飞行，但火炮命中时，命中点和火炮位置、飞机初始位置处于一个三角形上，只需要平面几何知识就能解决问题。在这个三角形中，飞机起始位置P和火炮T的位置是确定的，飞机的飞行方向也是确定的，所以θ角是已知的，D的长度也是已知的，F和G的长度虽然不知道，但在命中点H相遇的时候经过的时间t都是一样的，所以F/G的比例实际等于两者速度的比例，而两者的速度都是已知的。这样就可以用高中的余弦公式来解决这个求边长的问题：

图片：tj02.jpg

                   
其中V_p和V_g分别代表飞机的速度和炮弹飞行的速度，这是一个标准的1元2次方程，化简、消元对某这么一个非数学专业的来说太麻烦了，直接用求根公式求解吧，有好的化简方法请指教。

图片：tj03.jpg

 
在Unity中实现的方法:

复制代码

1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20

Vector3 hitPoint = Vector3.zero;//存放命中点坐标 //假设飞机物体是aircraft,炮塔物体是gun 两者间的方向向量就是两种世界坐标相减 Vector3 D = gun.transform.position - aircraft.transform.position; //用飞机transform的TransformDirection方法把前进方向变换到世界坐标，就是飞机飞行的世界方向向量了 Vector3 aircraftDirection = aircraft.transform.TransformDirection(Vector3.foward); //再用Vector3.Angle方法求出与飞机前进方向之间的夹角 float THETA = Vector3.Angle(D,aircraftDirection); float DD = D.magnitude;//D是飞机炮塔间方向向量，D的magnitude就是两种间距离 float A =1-Mathf.Pow((gunVelocity/aircraftVelocity),2);//假设炮弹的速度是gunVeloctiy飞机的飞行线速度是aircraftVeloctiy float B = -(2*DD*Mathf.Cos(THETA**Mathf.Deg2Rad));//要变换成弧度 float C = DD*DD; float DELTA = B*B-4*A*C; if (DELTA>=0){//如果DELTA小于0，无解    float F1 = (-B+Mathf.Sqrt(B*B-4*A*C))/(2*A);    float F2 = (-B-Mathf.Sqrt(B*B-4*A*C))/(2*A);    if(F1    F1 = F2;    //命中点位置等于 飞机初始位置加上计算出F边长度乘以飞机前进的方向向量，这个乘法等于把前进的距离变换成世界坐标的位移    hitPoint = aircraft.transform.position + aircraftDirection * F1;        }

假设你的炮弹是个Prefab叫projectilePrefab,带有一个刚体，那么可以这样生成炮弹实例:

复制代码

1 2 3 4 5 6

if(hitPoint != Vector3.zero){//如果有解     //生成一个炮弹实例，位置在炮塔的位置，方向是从炮塔指向命中点     GameObject obj = (GameObject)Instantiate(projectilePrefab,gun.transform.position,Quaternion.LookRotation(hitPoint));     //假设muzzleVelocity是设定的炮弹速度(0,0,muzzleVelocity)表示往正z方向运动,用TransformDirection把这个速度变换成世界坐标的速度向量    obj.rigidbody.velocity = obj.transform.TransformDirection(new Vector3(0,0,muzzleVelocity)); }

经过以上计算，炮弹可以准确的命中飞行中的目标，只要目标是按照固定速度和方位角飞行的，可以百发百中。当然也会有无解的情况，所以计算的时候判断了Delta,一共也就是几条语句。

2.抛物线弹道
考虑进重力影响，炮弹的弹道就是一个抛物线方程，而目标还是在3D空间的匀速直线运动，一个空间直线方程。

图片：tj04.jpg

一个曲线方程和一个直线方程，以隐含参数t(飞行时间)求共同解(相交)问题，列方程组:

图片：tj05.jpg

 
其中Vp和Vg分别代表飞机和炮弹飞行速度，角度Theta是炮弹射出时的仰角，t是飞行时间。这是个非齐次非线性隐含微分方程组，以某人的数学基础，看不出有什么特殊解的方法，用常规的迭代逼近求解吧，求达人提供更好方法。
迭代的过程大致是：
        1.用一组预测的xy落点坐标带入抛物线方程
       2.求出发射的角度和飞行时间t
       3.将时间带t入直线方程，求出相应的xy坐标
       4.将这个坐标与之前猜测的xy坐标进行比较，如果差值小于允许误差，迭代结束返回结果
       5.如果差值大于误差，将这个新的xy作为下一次计算的预测xy,返回步骤1
   这个过程的物理含义可以这样理解：瞄准飞机现在的位置发射，等炮弹飞到的时候飞机已经往前飞行了一段距离，把炮弹飞行时间乘以飞机速度，得到飞机在该时刻的实际位置，下次瞄准这个位置，再计算，因为目标变了，炮弹的飞行时间也变了，所以该时刻飞机位置也不同了，就这样不停循环，炮弹落点追赶飞机位置，直到两者差距无穷小。

针对抛物线方程把t带入，得到:

图片：tj06.jpg

 
然后用基础代数方法进行推导化简，再用通用求根公式得到：

图片：tj07.jpg

这样θ角就可以通过预测的落点坐标、炮弹初速度、重力加速度g来求出。
迭代是有很多技巧的，这些内容需要复习大学微积分课程。好的迭代方法能够快速收敛，最大化的解释运算开销。望高数达人提供更佳的迭代方法。
在Unity中实现，有几个核心思想：
   1.迭代体用函数递归来实现
   2.抛物线本身是2D曲线，所以其实不需要3重坐标就能计算，每次运算时把z指向预测的落点，第3个坐标可以无视
   3.各种变换可以快速的通过向量、矩阵运算得到，很方便，不需要总是借助transform

复制代码

1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65

//抛物线方程 X Y代表预测落点，V代表炮弹初速，G是重力加速度 返回值是Vector2,其中x是发射角，y是飞行时间 Vector2 formulaProjectile(float X,float Y,float V,float G){ if(G ==0){//如果无重力 问题就成了简单的三角函数 THETA等于atan(y/x) 飞行时间就等于（Y/sin(THETA)）（斜边长）再除以速度     float THETA = Mathf.Atan(Y/X);     float T = (Y/Mathf.Sin(THETA))/V;     return(new Vector2(THETA,T)); }else{//用上面的公式进行计算     float DELTA = Mathf.Pow(V,4)-G*(G*X*X-2*Y*V*V);     if(DELTA < 0){//DELTA小于0无解         return Vector2.zero;     }     float THETA1 = Mathf.Atan((-(V*V)+Mathf.Sqrt(DELTA))/(G*X));     float THETA2 = Mathf.Atan((-(V*V)-Mathf.Sqrt(DELTA))/(G*X));     if(THETA1>THETA2)//取较小值         THETA1 = THETA2;     float T = X/(V*Mathf.Cos(THETA1));//用抛物线水平运动方程计算飞行时间 比较简单     return new Vector2(THETA1,T);     } } //目标运动的直线方程 VT是目标运动速度 PT是目标当前位置 DT是目标运动方向 TT是运动时间 返回值是目标经过时间TT以后的实际位置 Vector3 formulaTarget(float VT,Vector3 PT,Vector3 DT,float TT){ //简单的一句话搞定直线方程计算 目标实际位置=目标当前位置+目标运动方向向量*（目标飞行速度*目标飞行时间)     return PT + DT * (VT * TT); } //主迭代函数 参数灰常多 用于算法演示 实际使用是可以简化的 //gunVelocity:炮弹初速度 gunPosition:炮塔世界坐标 aircraftVelocity:飞机线速度 aircraftPosition:飞机当前位置世界坐标 //aircraftDirection:飞机飞行方向向量 hitPoint:预测的命中点 G:重力加速度 accuracy:计算精度 小于这个值认为计算完成 diff:上次迭代的差值 //返回值是炮塔发射时瞄准点的坐标(注意不是实际命中点） Vector3 calculateNoneLinearTrajectory(float gunVelocity,Vector3 gunPosition,float aircraftVelocity, Vector3 aircraftPosition,Vector3 aircraftDirection,Vector3 hitPoint,float G,float accuracy,float diff){ //如果预测命中点是0 无解 返回0 if(hitPoint == Vector3.zero){     return Vector3.zero; } //把炮塔正z指向预测命中点在炮塔高度的一个水平面上的投影点 //这样就构造了一个以炮塔为原点，以重力方向为-y轴 以炮塔正前方为x轴的标准抛物线2D坐标系，这个要自己体会下 Vector3 gunDirection = new Vector3(hitPoint.x,gunPosition.y,hitPoint.z) - gunPosition; //构造一个从世界坐标到炮塔坐标的旋转矩阵 Quaternion gunRotation = Quaternion.FromToRatation(gunDirection,Vector3.forward); //把预测命中点变换到炮塔坐标（减法是计算相对坐标差，再旋转到炮塔当前坐标来） Vector3 localHitPoint = gunRotation * (hitPoint - gunPosition); float V = gunVelocity; float X = localHitPoint.z;//注视方向 前方是z，也就是抛物线坐标里的X float Y = localHitPoint.y; Vector2 TT = formulaProjectile(X,Y,V,G);//用抛物线方程计算射击仰角和飞行时间 if(TT == Vector2.zero){//如果无解 返回     return Vector3.zero; } float VT = aircraftVelocity; Vector3 PT = aircraftPosition; Vector3 DT = aircraftDirection; float T = TT.y;//TT的y是用抛物线方程计算出的弹丸飞行时间 Vector3 newHitPoint = formulaTarget(VT,PT,DT,T);//带入直线方程计算目标实际位置 注意目标的计算是在3D世界坐标进行的 float diff1 = (newHitPoint - hitPoint).magnitude;//判断预测点和实际目标位置的距离 if (diff1 > diff){//如果距离大于上一次计算的距离 那么要么迭代算法有问题 是发散的 要么就无解 返回0     return Vector3.zero; } if(diff1     gunRotation = Quaternion.Inverse(gunRotation);//把刚才构造的旋转矩阵进行逆变换，从炮塔坐标变回世界坐标     Y = Mathf.Tan(TT.x)*X;//TT的x是炮弹射出的仰角tan(仰角)*水平距离=垂直高度了（三角函数），这才是瞄准点的高度    return gunRotation * new Vector3(0,Y,X) + gunPosition;//把瞄准点变换回世界坐标 注意X其实是Z } //即不是无解 也未达到精度要求 递归调用继续迭代 其中预测命中点用目标轨迹方程计算出的新位置取代 参考差值用本次计算的差值取代 return calculateNoneLinearTrajectory(gunVelocity,gunPosition,aircraftVelocity,aircraftPosition,aircraftDirection,newHitPoint,G,accuracy,diff1); }

一个炮弹运动轨迹方程 一个目标运动轨迹方程，加一个迭代函数，就能完成计算抛物线弹道命中直线匀速移动目标的问题。实际使用的时候，可以先用方法1直线弹道算出一个命中点，作为初始预测点带入进行迭代，可以减少迭代次数。过程里使用了大量简化的向量和矩阵运算，对这部分不熟的读起来可能费劲。
在几千米范围以内的飞机，飞行速度在300-700km/h,炮弹出膛速度在500m/s（2战水平，其实高射炮出膛速度不止这么点），命中精度10m以内的前提下，基本上4次迭代以内可以完成。

3.更多复杂因素的计算
   在实际情况中，还可能有更多的影响。比如目标不是匀速直线而是加速运动或者曲线运动，比如空气阻力对弹道的影响，弹丸质心不在几何中心时与重力、空间阻力夹角产生的偏转力矩，炮弹在移动的平台上射击移动的目标。另外炮弹出射点是从炮口算起，在旋转炮塔和炮管的情况下，这个出射点其实是个球面轨迹而不是个固定点。火炮发现目标到炮口转动到合适位置的时间里，目标又发生了位移，所以还要计算这个炮塔旋转的提前量。这一系列的复杂问题其实都可以通过联立方程组，然后迭代求解的方法实现，原理完全一样，只是计算复杂度大大增加。

比如在考虑空气阻力等情况下，炮弹的轨迹方程会是这种形式：

图片：tj08.jpg

 
这些影响因素可能是线性的、2次乃至高次的。根据上面的算法，只要把抛物线方程组变成这个新的高次方程组求解，也可以适用。
再比如目标飞行的不是直线而是圆形，那么把目标的方程组变换成圆方程，也可以适用。当然在目标轨迹是非线性轨迹的情况下，迭代就不能用这种线性的迭代了，否则迭代结果会一会收敛一会发散，常规的方法是用目标轨迹函数的导函数计算迭代，这部分实在很难做到通用，需要根据具体情况调整。

给出一个概念方程组：

图片：tj09.jpg

把这些方程组中按照影响关系进行多次分步迭代，最终能得到合适的解或者判断无解。这组方程可以应对各种复杂情况的组合，实际上军事上火控系统正是这样计算的。不过在游戏中，通常不需要这么复杂的计算，只要简单的模拟就足够了，所以只是从概念层面讨论一下,如果这些复杂因素都考虑进去，完全可以作成一个可视的军事仿真的程序来了。

惯例...只写原理不付DEMO大致是没多少人看的，附上自己写的demo

图片：tj10.jpg

Reset Target:设置目标飞机以随机方位角和速度飞行
Gravity ON/OFF：设置是否开启重力
Aiming Mode: Manual/Auto 设置瞄准模式人工/自动
人工模式下：wsad键上下左右旋转炮管方位角 空格键击发
自动模式下：炮管自动瞄准提前量瞄准点，空格击发 百发百中
AutoCam ON/OFF:设置飞机小镜头的显示模式，关闭自动镜头可以用按钮调整镜头的角度 + -按钮缩放镜头

图片：tj12.jpg

图片：tj17.jpg

Change Focus:改变主镜头焦点，在高射炮和目标飞机之间切换，以飞机为焦点时的镜头：

图片：tj11.jpg

 
如果无法命中，会发出提示音效
 
不同视角下的效果：百发百中的弹道 只给了炮弹一个初速度和方向 然后靠碰撞检测显示爆炸效果，过程完全靠物理引擎控制。

图片：tj13.jpg

图片：tj14.jpg

图片：tj16.jpg

图片：tj19.jpg

人工发射模式：

图片：tj15.jpg

图片：tj20.jpg

设置参数：
速度的单位都是m/s，长度单位都是m
Range是飞机初始位置的范围
Gravity