FPSカメラの作り方

// HAngleの取得関数
float FpsCamera::_GetHAngle(Vec3D* vEye, Vec3D* vTgt)
{
	// 注視点への向きベクトルを求める
	Vec3D vDir;
	Vec3D_Sub( &vDir, vTgt, vEye );
	
	// HAngle(XZ平面での角度)を求める
	float deg = Atan2Deg( -vDir.z, vDir.x );
	
	float __ADJ = 90.0f; // 調整角度(Z方向を基準に回転する)
	deg += __ADJ;
	
	// -180～180に丸める
	if(deg > 180.0f)  { deg -= 360.0f; }
	if(deg < -180.0f) { deg += 360.0f; }
	
	return deg;

// VAngleの取得関数
float FpsCamera::_GetVAngle(Vec3D* vEye, Vec3D* vTgt)
{
	// 注視点への向きベクトルを求める
	Vec3D vDir;
	Vec3D_Sub( &vDir, vTgt, vEye );
	
	float fFront;
	{	// カメラの前方方向値
		Vec3D _vFront;
		Vec3D_Copy( &_vFront, &vDir );
		_vFront.y = 0; // XZ平面での距離なのでYはいらない
		fFront = Vec3D_Length( &_vFront );
	}
	
	// Y軸とXZ平面の前方方向との角度を求める
	float deg = Atan2Deg( -vDir.y, fFront );
	
	// 可動範囲は-90～90
	if(deg > 90.0f)  { deg = 180.0f  - deg; }
	if(deg < -90.0f) { deg = -180.0f - deg; }
	
	return deg;

// カメラの回転値を更新する
void FpsCamera::UpdateRotate()
{
	// ★１．視点・注視点→回転座標への変換-----------
	Vec3D vEye, vTgt;
	GetEye(&vEye); // カメラ視点の取得
	GetTgt(&vTgt); // カメラ注視点の取得
	m_HAngle = _GetHAngle( &vEye, &vTgt ); // 水平方向の回転角度を取得
	m_VAngle = _GetVAngle( &vEye, &vTgt ); // 垂直方向の回転角度を取得
	
	// ★２．入力を元に回転する-----------------------
	// ■視点移動(回転)
	Vec2D stick; // ※予め移動値が入っているとします

// カメラを移動・回転させる
void FpsCamera::Move()
{
	// ★１．視点・注視点→回転座標への変換-----------
	m_HAngle = _GetHAngle(GetEye(), GetTgt());
	m_VAngle = _GetVAngle(GetEye(), GetTgt());
	
	// ★２．入力を元に回転する-----------------------
	// ■視点移動(回転)
	Vec2D stick; // ※予め移動値が入っているとします
	m_HAngle -= stick.x; // 水平方向への回転
	m_VAngle += stick.y; // 垂直方向への回転
	
	// ■平行移動
	float mx, mz; // XZ方向 ※予め移動値が入っているとします
	
	// ・3次元ベクトルにセット
	Vec3D vTranslate;
	Vec3D_Set( &vTranslate, mx, 0, mz );
	
	// ★３．回転座標→３次元座標への変換-------------
	// ■視点座標を取得する
	Vec3D vEye;
	GetEye( &vEye );
	// ■注視点は初期化しておく(後で代入します)
	Vec3D vTgt;
	Vec3D_Zero( &vTgt );
	
	// ■HAngle/VAngleを行列に変換する
	Matrix34 mRot;
	Matrix34_Identity(&mRot);
	Matrix34_RotXYZDeg( &mRot, m_VAngle, m_HAngle, 0 ); // 回転行列生成(※１)
	
	// ・平行移動
	Vec3D_Transform( &vTranslate, &mRot, &vTranslate );
	vTranslate.y = 0.0f; // XZ平面での移動なので、Y移動値は無視する
	Vec3D_Add( &vEye, &vEye, &vTranslate ); // 視点を動かす
	
	// ・回転
	Vec3D vDir;
	Vec3D_Set( &vDir, 0, 0, 1.0f ); // Z方向を基準に回転
	Vec3D_Transform( &vDir, &mRot, &vDir ); // 方向ベクトルの回転(※2)