youmuliu/stgsharp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

daily update on 20230822 by nitload youmu

Browse Source
This commit is contained in:
Nitload
2023-08-22 23:01:20 +08:00
parent 969406c4e4
commit 8aac9fee87
111 changed files with 3205 additions and 11145 deletions
Download Patch File Download Diff File Expand all files Collapse all files
源代码/StgSharp/Math/Linear/vec3d.cs
+34 -84
View File
@@ -1,125 +1,75 @@
using StgSharp.Control;
using System;
using System.Runtime.CompilerServices;
using System.Runtime.InteropServices;
namespace StgSharp.Math
{
public class Vec3d
[StructLayout(LayoutKind.Explicit,Size = 16,Pack = 16)]
public struct Vec3d
{
public static Vec3d defaultValue =
new Vec3d(0, 0, 0);
[FieldOffset(0)]
internal M128 vec;
internal M128Map _map;
internal IntPtr _m128Ptr;
[FieldOffset(0)] public float X;
[FieldOffset(4)] public float Y;
[FieldOffset(8)] public float Z;
public unsafe float X
public Vec3d(
float x, float y, float z)
{
get { return ((M128*)_m128Ptr)->single_0; }
set { ((M128*)_m128Ptr)->single_0 = value; }
}
public unsafe float Y
{
get { return ((M128*)_m128Ptr)->single_1; }
set { ((M128*)_m128Ptr)->single_1 = value; }
}
public unsafe float Z
{
get { return ((M128*)_m128Ptr)->single_2; }
set { ((M128*)_m128Ptr)->single_2 = value; }
}
internal Vec3d(IntPtr value)
{
if ((long)value == -1)
{
throw new Exception("Failed to creat M128 pointer");
}
else
{
_m128Ptr = value;
}
}
public Vec3d(float x, float y, float z)
{
_m128Ptr = internalIO.load_internal(x,y,z,0);
}
internal Vec3d()
{
_m128Ptr = defaultValue._m128Ptr;
X = x; Y = y; Z = z;
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static Vec3d operator +(Vec3d vec1, Vec3d vec2)
{
return new Vec3d(
internalIO.addps_internal(vec1._m128Ptr, vec2._m128Ptr)
vec1.X + vec2.X,
vec1.Y + vec2.Y,
vec1.Z + vec2.Z
);
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static Vec3d operator -(Vec3d vec1, Vec3d vec2)
{
return new Vec3d(
internalIO.subps_internal(vec1._m128Ptr, vec2._m128Ptr)
vec1.X - vec2.X,
vec1.Y - vec2.Y,
vec1.Z - vec2.Z
);
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static Vec3d operator *(Vec3d vec, float value)
{
return new Vec3d(
internalIO.mulps_const_internal(vec._m128Ptr,value)
vec.X * value,
vec.Y * value,
vec.Z * value
);
}
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static Vec3d operator /(Vec3d vec, float value)
{
return new Vec3d(
internalIO.divps_const_internal(vec._m128Ptr,value)
vec.X/value,
vec.Y/value,
vec.Z/value
);
}
/**/
[MethodImpl(MethodImplOptions.AggressiveInlining)]
public static float operator *(Vec3d vec1, Vec3d vec2)
{
//return VectorCalc.Multiple(vec1,vec2);
return 0;
}
/**/
public unsafe override string ToString()
{
return (*(M128*)_m128Ptr).ToString();
}
public unsafe string ToString(string sample)
{
return $"{(*(M128*)_m128Ptr).single_0.ToString(sample)}\t"+
$"{(*(M128*)_m128Ptr).single_1.ToString(sample)}\t"+
$"{(*(M128*)_m128Ptr).single_2.ToString(sample)}\t"+
$"{(*(M128*)_m128Ptr).single_3.ToString(sample)}\t";
}
~Vec3d()
{
if (_map == null)
{
if (_m128Ptr != defaultValue._m128Ptr)
{
internalIO.deinitM128_internal(this._m128Ptr);
}
else
{
_m128Ptr = IntPtr.Zero;
}
}
else
{
}
return
vec1.X * vec2.X +
vec1.Y * vec2.Y +
vec1.Z * vec2.Z;
}
}