Unity实现汽车前后轮倒车轨迹计算
更新时间:2021年9月13日 00:00 点击:2420
汽车前后轮倒车轨迹计算附C#源码(Unity),供大家参考,具体内容如下
原理很简单, 都是高中的几何数学部分
需要的参数有:
- 车前后轴距;
- 车宽(左前轮与右前轮距离);
- 当前车轮角度(多数车33.5°);
- 是否要绘制前轮轨迹线;
///<summary> /// 获取行车轨迹预测index = 0 left轨迹 /// </summary> /// <param name="steeringAngle">方向盘角度</param> /// <param name="carWheelbase">汽车前后轴距</param> /// <param name="carWidth">车宽</param> /// <param name="length">点位密度</param> /// <param name="isFront">是否是前轮</param> /// <param name="maxAngle">轨迹的最大转弯角度</param> /// <returns>交叉数组,下标为0的是右边线, 下表为1的是左边线</returns> public Vector3[][] GetCarTrack(float steeringAngle, float carWheelbase, float carWidth, float length, bool isFront, float maxAngle = 90f) { float maxSteerAngle = _carControl._vehicleController.steering.maxSteerAngle; float theta = Mathf.Abs(steeringAngle / 180 * Mathf.PI); Vector3[][] track = new Vector3[2][]; List<Vector3> trackLeft = new List<Vector3>(); List<Vector3> trackRight = new List<Vector3>(); if (theta == 0) { for (float i = 0; i < length; i++) { float x = i / length * 5; if (isFront) { x *= 1; trackLeft.Add(new Vector3(x, 0f, carWidth)); trackRight.Add(new Vector3(x, 0f, 0f)); } else { x *= -1; trackLeft.Add(new Vector3(x, 0, carWidth)); trackRight.Add(new Vector3(x, 0, 0)); } } } else { if (isFront) { float r = (carWheelbase / Mathf.Tan(theta) + carWidth / 2) / Mathf.Cos(theta); float rMin = Mathf.Cos(theta) * r - carWidth; float theta1 = Mathf.Atan(carWheelbase / rMin); rMin = rMin / Mathf.Cos(theta1); float rMax = rMin + carWidth; float lineAngle = carWheelbase / (rMax * 2f * Mathf.PI) * 360f; for (int i = 0; i <= length; i++) { if (i / length >= (maxAngle - lineAngle) / maxAngle) { float x = rMin * Mathf.Cos(maxAngle / length * i * Mathf.Deg2Rad); float z = rMin * Mathf.Sin(maxAngle / length * i * Mathf.Deg2Rad); if (x >= carWheelbase) { if (steeringAngle > 0) { trackRight.Add(new Vector3(x - carWheelbase, 0, z - rMin + steeringAngle / maxSteerAngle * (carWidth / 2))); } else { trackRight.Add(new Vector3(x - carWheelbase, 0, -(z - rMin) + carWidth + steeringAngle / maxSteerAngle * (carWidth / 2))); } } x = rMax * Mathf.Cos(maxAngle / length * i * Mathf.Deg2Rad); z = rMax * Mathf.Sin(maxAngle / length * i * Mathf.Deg2Rad); if (x >= carWheelbase) { if (steeringAngle > 0) { trackLeft.Add(new Vector3(x - carWheelbase, 0, z - rMin + steeringAngle / maxSteerAngle * (carWidth / 2))); } else { trackLeft.Add(new Vector3(x - carWheelbase, 0, -(z - rMin) + carWidth + steeringAngle / maxSteerAngle * (carWidth / 2))); } } } } trackRight[trackRight.Count - 1] = Vector3.forward * trackRight[trackRight.Count - 1].z; trackLeft[trackLeft.Count - 1] = Vector3.forward * trackLeft[trackLeft.Count - 1].z; } else { float r = (carWheelbase / Mathf.Tan(theta) + carWidth / 2) / Mathf.Cos(theta); float rMin = Mathf.Cos(theta) * r - carWidth; float rMax = rMin + carWidth; float lineAngle = carWheelbase / (rMin * 2f * Mathf.PI) * 360f; for (int i = 0; i <= length; i++) { if (i / length >= (maxAngle - lineAngle) / maxAngle) { float x = -rMin * Mathf.Cos(maxAngle / length * i * Mathf.Deg2Rad); float z = rMin * Mathf.Sin(maxAngle / length * i * Mathf.Deg2Rad); if (steeringAngle > 0) { trackRight.Add(new Vector3(x, 0, z - rMin)); } else { trackRight.Add(new Vector3(x, 0, -(z - rMin) + carWidth)); } x = -rMax * Mathf.Cos(maxAngle / length * i * Mathf.Deg2Rad); z = rMax * Mathf.Sin(maxAngle / length * i * Mathf.Deg2Rad); if (steeringAngle > 0) { trackLeft.Add(new Vector3(x, 0, z - rMin)); } else { trackLeft.Add(new Vector3(x, 0, -(z - rMin) + carWidth)); } } } trackRight[trackRight.Count - 1] = Vector3.forward * trackRight[trackRight.Count - 1].z; trackLeft[trackLeft.Count - 1] = Vector3.forward * trackLeft[trackLeft.Count - 1].z; } } track[0] = trackLeft.ToArray(); track[1] = trackRight.ToArray(); trackLeft = trackRight = null; return track; }
以上就是本文的全部内容,希望对大家的学习有所帮助,也希望大家多多支持猪先飞。
相关文章
- 这篇文章主要为大家详细介绍了Unity时间戳的使用方法,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
Unity中 ShaderGraph 实现旋涡传送门效果入门级教程(推荐)
通过Twirl 旋转节点对Gradient Noise 梯度噪声节点进行操作,就可得到一个旋转的旋涡效果。具体实现代码跟随小编一起通过本文学习下吧...2021-07-11- 本文主要介绍了4种延时执行的方法,主要包括Update计时器,Invoke,协程,DoTween,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2021-07-07
- 这篇文章主要为大家详细介绍了Unity shader实现遮罩效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要介绍了unity 判断鼠标是否在哪个UI上的两种实现方法,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2021-04-10
- 这篇文章主要为大家详细介绍了Unity实现换装系统,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2021-04-11
- 这篇文章主要给大家介绍了关于利用unity代码C#封装为dll的相关资料,文中通过图文将实现的方法介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习学习吧...2020-06-25
- 这篇文章主要介绍了unity 实现摄像机绕某点旋转一周,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2021-04-12
- 这篇文章主要为大家详细介绍了Unity Shader实现径向模糊效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2021-08-09
- 这篇文章主要为大家详细介绍了Unity实现截图功能,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要为大家详细介绍了Unity Shader实现2D水流效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要介绍了Unity 按钮添加OnClick事件操作,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2021-04-10
- 这篇文章主要为大家详细介绍了Unity使用EzySlice实现模型多边形顺序切割,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-11-03
- 这篇文章主要为大家详细介绍了Unity Shader实现描边OutLine效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要为大家详细介绍了Unity Shader实现裁切效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要为大家详细介绍了unity实现车方向盘转动效果,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25
- 这篇文章主要为大家详细介绍了Unity实现汽车前后轮倒车轨迹计算,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2021-09-13
- 这篇文章主要介绍了Unity 点击UI与点击屏幕冲突的解决方案,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2021-04-10
- 这篇文章主要介绍了Unity中EventTrigger的几种使用操作,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2021-04-10
- 这篇文章主要为大家详细介绍了Unity实现人物平滑转身,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2020-06-25