//カメラ座標の設定
public void SetCaemraAxes()
{
CameraZ = LookatPoint - Setposition;
CameraZ.Normalization();
CameraX = Vector3D.Outer(Upward, CameraZ);
CameraX.Normalization();
CameraY = Vector3D.Outer(CameraZ, CameraX);
}
//カメラの回転
public void RotateCamera(double x1, double y1, double x2, double y2)
{
Vector2D A = new Vector2D();
Vector3D N1 = new Vector3D();
Vector3D N2 = new Vector3D();
Vector3D temp = new Vector3D();
double alpha, beta;
float x, y, z;
N1.X = Setposition.Y;
N1.Y = -Setposition.X;
N1.Z = LookatPoint.Z;
N1.Normalization();
N2.X = LookatPoint.X;
N2.Y = LookatPoint.Y;
N2.Z = 1;
N2.Normalization();
if (Upward.Z > 0)
{
A.X = (float)((x2 - x1) / w);
A.Y = (float)((y2 - y1) / h);
}
if (Upward.Z < 0)
{
A.X = (float)((x1 - x2) / w);
A.Y = (float)((y1 - y2) / h);
}
alpha = 2 * Math.PI * A.Y;
beta = 2 * Math.PI * A.X;
x = Setposition.X;
y = Setposition.Y;
z = Setposition.Z;
rotatematrix.Set_Rotate_ArbAx(N1, alpha);
temp = Setposition * rotatematrix;
rotatematrix.Set_Rotate_ArbAx(N2, beta);
temp = temp * rotatematrix;
SetPosition(temp.X, temp.Y, temp.Z);
if (Vector3D.Inner(temp2, Setposition - LookatPoint) > 0 && Upward.Z > 0) Upward.Z = -Upward.Z;
if (Vector3D.Inner(temp2, Setposition - LookatPoint) < 0 && Upward.Z < 0) Upward.Z = -Upward.Z;
if (Upward.Z > 0) temp2.Set(-Setposition.X, -Setposition.Y, LookatPoint.Z);
if (Upward.Z < 0) temp2.Set(Setposition.X, Setposition.Y, LookatPoint.Z);
}
