add quat(hpr) method
This commit is contained in:
parent
b776179c00
commit
47a9acad51
1 changed files with 3 additions and 0 deletions
|
@ -1355,6 +1355,9 @@ func quat*(heading, pitch, roll: float32): Quat =
|
||||||
result.y = t0 * t2 * t5 + t1 * t3 * t4
|
result.y = t0 * t2 * t5 + t1 * t3 * t4
|
||||||
result.z = t1 * t2 * t4 - t0 * t3 * t5
|
result.z = t1 * t2 * t4 - t0 * t3 * t5
|
||||||
|
|
||||||
|
func quat*(hpr: Vec3): Quat =
|
||||||
|
quat(hpr.x, hpr.y, hpr.z)
|
||||||
|
|
||||||
func hrp*(q: Quat): Vec3 =
|
func hrp*(q: Quat): Vec3 =
|
||||||
var ysqr = q.y * q.y
|
var ysqr = q.y * q.y
|
||||||
# roll
|
# roll
|
||||||
|
|
Loading…
Reference in a new issue