Unityで三角関数のテーブル化 | Codetter（こーどったー）

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
using System.Collections;
using System.Collections.Generic;
using UnityEngine;
// 自前の三角関数を置くクラス
public class DeltaFunc : MonoBehaviour
{
    private float[] sinTable;  // サインテーブル用配列
    public const int roundDivision = 1024; // 360°を何分割するか（２の累乗数）
    private const int roundDiv3_4 = roundDivision * 3 / 4;
    private const int roundDiv1_2 = roundDivision / 2;
    private const int roundDiv1_4 = roundDivision / 4;
    private Vector2 sinCos;  // GetSinCos関数内でXY方向の移動ベクトルの値を入れる変数
    private float[] atanTable;  // アークタンジェントテーブル用配列
    private const int atanDevide = roundDiv1_4;  // 0-45°を何分割するか
    //————————————————————
    //  スタート時に三角関数テーブル作成
    //————————————————————
    void Start () {
        //Sinテーブル作成（0～90°（0～(分周比の1/4 +1)）までをテーブル化）
        sinTable = new float[roundDiv1_4 + 1];
        for (int i = 0; i < sinTable.Length; i++)
        {
            float rad = 360 * i / roundDivision * Mathf.Deg2Rad;
            sinTable[i] = Mathf.Sin(rad);
        }
        //Atanテーブル作成（0～45°をatanDevideで分割しテーブル化）
        atanTable = new float[atanDevide + 1];
        for (int i = 0; i <= atanDevide; i++)
        {
            float r = (float)i / atanDevide;
            atanTable[i] = Mathf.Atan(r)* Mathf.Rad2Deg;
        }
    }
    //————————————————————
    //  テーブルを用いてSin、Cosの近似値を求める関数
    //  パラメータ：方向（roundDivisionで設定した分周比の範囲の整数）
    //  戻り値：Vector2型（y要素にsin、x要素にcosが入る）
    //————————————————————
    public Vector2 GetSinCos(int direction)
    {
        // 三角関数テーブル引き（directionは0から(分周比-1)の範囲）
        if (direction <= roundDiv1_4)  // 第１象限（0°<= 方向 <=90°）
        {
            sinCos.y = sinTable[direction];
            sinCos.x = sinTable[roundDiv1_4 – direction];
        }
        else if (direction <= roundDiv1_2)  // 第２象限（90°< 方向 <=180°）
        {
            sinCos.y = sinTable[roundDiv1_2 – direction];
            sinCos.x = sinTable[direction – roundDiv1_4] * -1;
        }
        else if (direction <= roundDiv3_4)  // 第３象限（180°< 方向 <=270°）
        {
            sinCos.y = sinTable[direction – roundDiv1_2] * -1;
            sinCos.x = sinTable[roundDiv3_4 – direction] * -1;
        }
        else // 第４象限（270°< 方向 <360°）
        {
            sinCos.y = sinTable[roundDivision – direction] * -1;
            sinCos.x = sinTable[direction – roundDiv3_4];
        }
        return sinCos;
    }
    //————————————————————
    //  テーブルを用いて二点間の角度の近似値（オイラー角）を求める関数
    //  パラメータ：dYに二点間のY方向差分、dXに二点間のX方向差分
    //  戻り値：0～360°（atan2とは異なり、負の値は取らない）
    //————————————————————
    public float GetAtan2(float dY, float dX)
    {
        // Y差分、X差分ともにゼロだった場合の例外処理
        if (dY == 0 && dX == 0) return 0;
        if (dY >= 0)  // 起点側から見てターゲットが第１or第２象限に存在
        {
            if (dX >= 0)  // 第１象限
            {
                if (dX >= dY)   // 0-45°
                {
                    return atanTable[(int)(dY / dX * atanDevide)];
                }
                else   // 45-90°
                {
                    return 90.0f – atanTable[(int)(dX / dY * atanDevide)];
                }
            }
            else          // 第２象限
            {
                if (dY >= -dX)   // 90-135°
                {
                    return 90.0f + atanTable[(int)(-dX / dY * atanDevide)];
                }
                else   // 135-180°
                {
                    return 180.0f – atanTable[(int)(dY / -dX * atanDevide)];
                }
            }
        }
        else  // 起点側から見てターゲットが第３or第４象限に存在
        {
            if (dX < 0)   // 第３象限
            {
                if (-dX >= -dY)   // 180-225°
                {
                    return 180.0f + atanTable[(int)(-dY / -dX * atanDevide)];
                }
                else   // 225-270°
                {
                    return 270.0f – atanTable[(int)(-dX / -dY * atanDevide)];
                }
            }
            else          // 第４象限
            {
                if (-dY >= dX)   // 270-315°
                {
                    return 270.0f + atanTable[(int)(dX / -dY * atanDevide)];
                }
                else   // 315-360°
                {
                    return 360.0f – atanTable[(int)(-dY / dX * atanDevide)];
                }
            }
        }
    }
}
XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX