Line data Source code
1 : package render3d
2 :
3 : import "math"
4 :
5 : // Vec は3D空間の点またはベクトル。Y が高さで、XZ がタイル平面に対応する
6 : type Vec struct{ X, Y, Z float64 }
7 :
8 : // Add は2つのベクトルを足す
9 1 : func Add(a, b Vec) Vec { return Vec{a.X + b.X, a.Y + b.Y, a.Z + b.Z} }
10 :
11 : // Scale はベクトルを定数倍する
12 1 : func Scale(a Vec, s float64) Vec { return Vec{a.X * s, a.Y * s, a.Z * s} }
13 :
14 1 : func sub(a, b Vec) Vec { return Vec{a.X - b.X, a.Y - b.Y, a.Z - b.Z} }
15 1 : func dot(a, b Vec) float64 { return a.X*b.X + a.Y*b.Y + a.Z*b.Z }
16 :
17 : func cross(a, b Vec) Vec {
18 1 : return Vec{a.Y*b.Z - a.Z*b.Y, a.Z*b.X - a.X*b.Z, a.X*b.Y - a.Y*b.X}
19 1 : }
20 :
21 : func norm(a Vec) Vec {
22 1 : l := math.Sqrt(dot(a, a))
23 1 : if l == 0 {
24 1 : return a
25 1 : }
26 1 : return Scale(a, 1/l)
27 : }
28 :
29 : // mat は行優先の4x4行列。点は列ベクトルとして mat*v で変換する
30 : type mat [16]float64
31 :
32 : func mul(a, b mat) mat {
33 1 : var c mat
34 1 : for i := range 4 {
35 1 : for j := range 4 {
36 1 : s := 0.0
37 1 : for k := range 4 {
38 1 : s += a[i*4+k] * b[k*4+j]
39 1 : }
40 1 : c[i*4+j] = s
41 : }
42 : }
43 1 : return c
44 : }
45 :
46 : func apply(m mat, p Vec) (x, y, z, wc float64) {
47 1 : x = m[0]*p.X + m[1]*p.Y + m[2]*p.Z + m[3]
48 1 : y = m[4]*p.X + m[5]*p.Y + m[6]*p.Z + m[7]
49 1 : z = m[8]*p.X + m[9]*p.Y + m[10]*p.Z + m[11]
50 1 : wc = m[12]*p.X + m[13]*p.Y + m[14]*p.Z + m[15]
51 1 : return
52 1 : }
53 :
54 : func perspective(fovyDeg, aspect, near, far float64) mat {
55 1 : f := 1.0 / math.Tan(fovyDeg*math.Pi/180/2)
56 1 : return mat{
57 1 : f / aspect, 0, 0, 0,
58 1 : 0, f, 0, 0,
59 1 : 0, 0, (far + near) / (near - far), (2 * far * near) / (near - far),
60 1 : 0, 0, -1, 0,
61 1 : }
62 : }
63 :
64 : func lookAt(eye, center, up Vec) mat {
65 1 : f := norm(sub(center, eye))
66 1 : s := norm(cross(f, up))
67 1 : u := cross(s, f)
68 1 : return mat{
69 1 : s.X, s.Y, s.Z, -dot(s, eye),
70 1 : u.X, u.Y, u.Z, -dot(u, eye),
71 1 : -f.X, -f.Y, -f.Z, dot(f, eye),
72 1 : 0, 0, 0, 1,
73 1 : }
74 : }
75 :
76 : // At は座標から点を作る。3成分を並べる式が読みやすくなる
77 1 : func At(x, y, z float64) Vec { return Vec{X: x, Y: y, Z: z} }
|