| | |
| |
|
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| | |
| |
|
| | import numpy as np |
| |
|
| |
|
| | def vec3(x, y, z): |
| | return np.array([x, y, z], dtype=np.float32) |
| |
|
| |
|
| | def radians(v): |
| | return np.radians(v) |
| |
|
| |
|
| | def identity(): |
| | return np.identity(4, dtype=np.float32) |
| |
|
| |
|
| | def empty(): |
| | return np.zeros([4, 4], dtype=np.float32) |
| |
|
| |
|
| | def magnitude(v): |
| | return np.linalg.norm(v) |
| |
|
| |
|
| | def normalize(v): |
| | m = magnitude(v) |
| | return v if m == 0 else v / m |
| |
|
| |
|
| | def dot(u, v): |
| | return np.sum(u * v) |
| |
|
| |
|
| | def cross(u, v): |
| | res = vec3(0, 0, 0) |
| | res[0] = u[1] * v[2] - u[2] * v[1] |
| | res[1] = u[2] * v[0] - u[0] * v[2] |
| | res[2] = u[0] * v[1] - u[1] * v[0] |
| | return res |
| |
|
| |
|
| | |
| |
|
| |
|
| | def translate(m, v): |
| | res = np.copy(m) |
| | res[:, 3] = m[:, 0] * v[0] + m[:, 1] * v[1] + m[:, 2] * v[2] + m[:, 3] |
| | return res |
| |
|
| |
|
| | def rotate(m, angle, v): |
| | a = angle |
| | c = np.cos(a) |
| | s = np.sin(a) |
| |
|
| | axis = normalize(v) |
| | temp = (1 - c) * axis |
| |
|
| | rot = empty() |
| | rot[0][0] = c + temp[0] * axis[0] |
| | rot[0][1] = temp[0] * axis[1] + s * axis[2] |
| | rot[0][2] = temp[0] * axis[2] - s * axis[1] |
| |
|
| | rot[1][0] = temp[1] * axis[0] - s * axis[2] |
| | rot[1][1] = c + temp[1] * axis[1] |
| | rot[1][2] = temp[1] * axis[2] + s * axis[0] |
| |
|
| | rot[2][0] = temp[2] * axis[0] + s * axis[1] |
| | rot[2][1] = temp[2] * axis[1] - s * axis[0] |
| | rot[2][2] = c + temp[2] * axis[2] |
| |
|
| | res = empty() |
| | res[:, 0] = m[:, 0] * rot[0][0] + m[:, 1] * rot[0][1] + m[:, 2] * rot[0][2] |
| | res[:, 1] = m[:, 0] * rot[1][0] + m[:, 1] * rot[1][1] + m[:, 2] * rot[1][2] |
| | res[:, 2] = m[:, 0] * rot[2][0] + m[:, 1] * rot[2][1] + m[:, 2] * rot[2][2] |
| | res[:, 3] = m[:, 3] |
| | return res |
| |
|
| |
|
| | def perspective(fovy, aspect, zNear, zFar): |
| | tanHalfFovy = np.tan(fovy / 2) |
| |
|
| | res = empty() |
| | res[0][0] = 1 / (aspect * tanHalfFovy) |
| | res[1][1] = 1 / (tanHalfFovy) |
| | res[2][3] = -1 |
| | res[2][2] = -(zFar + zNear) / (zFar - zNear) |
| | res[3][2] = -(2 * zFar * zNear) / (zFar - zNear) |
| |
|
| | return res.T |
| |
|
| |
|
| | def ortho(left, right, bottom, top, zNear, zFar): |
| | |
| | res = identity() |
| | res[0][0] = 2 / (right - left) |
| | res[1][1] = 2 / (top - bottom) |
| | res[2][2] = -2 / (zFar - zNear) |
| | res[3][0] = -(right + left) / (right - left) |
| | res[3][1] = -(top + bottom) / (top - bottom) |
| | res[3][2] = -(zFar + zNear) / (zFar - zNear) |
| | return res.T |
| |
|
| |
|
| | def lookat(eye, center, up): |
| | f = normalize(center - eye) |
| | s = normalize(cross(f, up)) |
| | u = cross(s, f) |
| |
|
| | res = identity() |
| | res[0][0] = s[0] |
| | res[1][0] = s[1] |
| | res[2][0] = s[2] |
| | res[0][1] = u[0] |
| | res[1][1] = u[1] |
| | res[2][1] = u[2] |
| | res[0][2] = -f[0] |
| | res[1][2] = -f[1] |
| | res[2][2] = -f[2] |
| | res[3][0] = -dot(s, eye) |
| | res[3][1] = -dot(u, eye) |
| | res[3][2] = -dot(f, eye) |
| | return res.T |
| |
|
| |
|
| | def transform(d, m): |
| | return np.dot(m, d.T).T |
| |
|