DirectX11で壁沿りベクトルを実装したい

Question

前提・実現したいこと

directx11でレースゲームを作っているのですが、斜めの当たり判定(OBB)を持つ壁にプレイヤー(OBB)が衝突したときに壁沿りベクトルを使って壁を沿う処理を実装したいです。
現状では壁沿りベクトルを行っている関数内の計算が間違っているのか、設定する引数が間違っているのか、プレイヤーが斜めの壁に衝突したときにプレイヤーが原点(0,0,0)に(瞬間)移動してしまいます。

該当のソースコード

//壁沿りベクトル
//front : 進行ベクトル
//normal: 衝突点での法線ベクトル
XMFLOAT3 CCollision::CalcWallScratchVector( XMFLOAT3& front, const XMFLOAT3& normal)
{
    //XMFLOAT3 normal_n;//正規化した法線ベクトル
	//XMFLOAT3 StaggeredNormal;//ずらした法線ベクトル
	//XMFLOAT3 out;//戻り値

	normal_n = GetMath()->Vector_Normalize(normal);//法線ベクトルを正規化
	//進行ベクトルの逆ベクトルと法線ベクトルの内積
	StaggeredNormal.x = GetMath()->Dot3DX(-front, normal_n);
	StaggeredNormal.y = GetMath()->Dot3DY(-front, normal_n);
	StaggeredNormal.z = GetMath()->Dot3DZ(-front, normal_n);
	out.x = front.x + StaggeredNormal.x * normal.x;
	out.y = front.y + StaggeredNormal.y * normal.y;
	out.z = front.z + StaggeredNormal.z * normal.z;
	return out;
}

//実行部分
//プレイヤー(OBB)と斜めの壁(OBB)の当たり判定
if (GetCollision()->CollisionOBB3D(GetModel()->GetPos(),//プレイヤーの位置
		GetModel()->GetSize(),//プレイヤーの当たり判定のサイズ
		GetModel()->GetRot(),//プレイヤーの向き
		GetFenceOutSide()->GetPosOBBNo1(),//壁の位置
		GetFenceOutSide()->GetSizeOBBNo1(),//壁の当たり判定のサイズ
		GetFenceOutSide()->GetRotOBBNo1(),//壁の向き
		&GetFenceOutSide()->GetFenceNormal[0]))//壁の法線ベクトル
	{
		PrintDebugProc("[FenceOutSideOBBHitPlayeOBB : No1 : Hit]\n");
		//壁沿りベクトル
　　　   //引数1 : プレイヤーの進行ベクトル(正面ベクトル)
        //引数2 : 壁の衝突時の法線ベクトル(CollisionOBB3D関数の7つ目の引数に設定した法線ベクトルを格納したもの)
		*GetModel()->GetPos() += GetCollision()->CalcWallScratchVector(GetModel()->vecForward, GetCollision()->Obj2_Normalvector);
	}

試したこと

↓参考にしたサイト
http://marupeke296.com/COL_Basic_No5_WallVector.html

補足情報（FW/ツールのバージョンなど）

Visual Studio Community 2019
Windows10
DirectX11

Answer 1

壁沿りベクトル関数内の計算と法線ベクトルの設定を上記のソースのように直しました。
一応は壁に沿って動くようになったので自己解決とさせていただきます。

Answer 2

座標に正規化したベクトルを渡すと瞬間移動しますね。
その処理は座標(Pos)ではなく回転(Angle)の処理にするべきではないかと思います。
自動で進む方向のベクトルを用意し、座標と回転は追従するシステムを組んだ方が良いでしょう。

この場合ですとこのようにしてあげれば、原点に瞬間移動することはなくなると思います。

//+=のoperatorがあることを予めご確認下さい。
*GetModel()->GetPos() += GetCollision()->CalcWallScratchVector(GetModel()->vecForward, GetCollision()->Obj2_Normalvector);

Comments

[futon03]

回答ありがとうございます。
+=のoperator関数の実装に時間がかかり返信遅くなりました。
今のところ*GetModel()->GetPos() += GetCollision()->CalcWallScratchVector(GetModel()->vecForward, GetCollision()->Obj2_Normalvector);
でも瞬間移動してしまいます。