public void DrawSphereCapsule(float3 spherePos, float3 capsulePos, float3 capsuleRot, float shpereRadius, float capsuleRadius, float capsuleHalfLength)
    {
        shapeA.transform.position = spherePos;
        shapeB.transform.position = capsulePos;

        float xRotation = ColPhysics.DegreesToRadians(90);

        shapeB.transform.rotation = quaternion.EulerXYZ(capsuleRot.x + xRotation, capsuleRot.y, capsuleRot.z);

        shapeA.transform.localScale = new float3(shpereRadius * 2, shpereRadius * 2, shpereRadius * 2);
        shapeB.transform.localScale = new float3(capsuleRadius * 2, capsuleHalfLength * 2, capsuleRadius * 2);
    }
    public void DrawCapsuleBox(float3 capsulePos, float3 boxPos, float3 capusleRot, float3 boxRot, float capsuleRadius, float capsuleHalfLength, float3 boxHalfSize)
    {
        shapeA.transform.position = capsulePos;
        shapeB.transform.position = boxPos;

        float xRotation = ColPhysics.DegreesToRadians(90);

        shapeA.transform.rotation = quaternion.EulerXYZ(capusleRot.x + xRotation, capusleRot.y, capusleRot.z);
        shapeB.transform.rotation = quaternion.EulerXYZ(boxRot);

        shapeA.transform.localScale = new float3(capsuleRadius * 2, capsuleHalfLength * 2, capsuleRadius * 2);
        shapeB.transform.localScale = boxHalfSize * 2;
    }
    public void DrawCapsules(float3 posA, float3 posB, float3 rotA, float3 rotB, float radiusA, float radiusB, float halfLengthA, float halfLengthB)
    {
        shapeA.transform.position = posA;
        shapeB.transform.position = posB;

        float xRotation = ColPhysics.DegreesToRadians(90);

        shapeA.transform.rotation = quaternion.EulerXYZ(rotA.x + xRotation, rotA.y, rotA.z);
        shapeB.transform.rotation = quaternion.EulerXYZ(rotB.x + xRotation, rotB.y, rotB.z);

        shapeA.transform.localScale = new float3(radiusA * 2, halfLengthA * 2, radiusA * 2);
        shapeB.transform.localScale = new float3(radiusB * 2, halfLengthB * 2, radiusB * 2);
    }