云台(PTZ)Unity模拟还原

首先,介绍一下云台:

  三轴增稳云台是一种为实现目标物体姿态稳定控制的装置,换言之,就是使物体可以在运动中保持其姿态的静止。

  以摄影为例,应用了增稳云台后可以使摄像者依然可以在运动的过程中拍摄出平稳的画面。增稳云台主要由三轴陀螺仪和三轴加速度传感器构成的IMU反馈系统和伺服电机两部份组成。在支撑臂上分布有三个伺服电机,分别负责前后,左右,上下三个方向的旋转。在商业航拍、空中摄影、空中巡航监视及滞空平台的实际工作中,大多都必须使用云台来稳定摄像头的方向,以保持拍摄画面的清晰与稳定。

采用三个轴去摆正角度,只写了欧拉角的还原,没有用四元数

下面不多废话,直接上代码

using UnityEngine;

/// 
/// 云台模拟
/// 
public class PTZ : MonoBehaviour {

    /// 
    /// 沿Y轴旋转物体
    /// 
    [SerializeField] private Transform rotateY;
    /// 
    /// 沿X轴旋转物体
    /// 
    [SerializeField] private Transform rotateX;
    /// 
    /// 相机
    /// 
    [SerializeField] private Transform autoCamera;

    private Vector3 oldEulerAngles;//上一帧的世界坐标
    private Vector3 anglesDifference;//角度差值

    private void Update()
    {
        //控制旋转
        if (Mathf.Abs(Input.GetAxis("Horizontal")) > 0)
        {
            rotateY.Rotate(Vector3.up, Input.GetAxis("Horizontal"));
        }
        else if (Mathf.Abs(Input.GetAxis("Vertical")) > 0)
        {
            rotateX.Rotate(Vector3.left, Input.GetAxis("Vertical"));
        }
        //非自我控制状态 需要摆正
        else
        {
            anglesDifference = autoCamera.eulerAngles - oldEulerAngles;
        } 
    }

    private void LateUpdate()
    {
        if (autoCamera.eulerAngles == oldEulerAngles) return;
        
        //摆正
        autoCamera.eulerAngles -= new Vector3(0, 0, anglesDifference.z);
        rotateY.eulerAngles -= new Vector3(0, anglesDifference.y, 0);
        rotateX.eulerAngles -= new Vector3(anglesDifference.x, 0, 0);

        oldEulerAngles = autoCamera.eulerAngles;        
    }
}

 

 

 

你可能感兴趣的:(Unity3D)