fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-13 10:50:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

define FLT_EPSILON; be descriptive about upper_right_triangle() method

Browse Source
This commit is contained in:
TSC21
2019-02-19 14:44:46 +00:00
committed by Nuno Marques
parent 7355a29a2a
commit ec436d5aee
11 changed files with 43 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files
test/test_data.py
+5 -5
View File
@@ -75,9 +75,9 @@ psi = 0.3
print('euler', phi, theta, psi)
q = euler_to_quat(phi, theta, psi)
assert(abs(norm(q) - 1) < __FLT_EPSILON__)
assert(abs(norm(q) - 1) < __FLT_EPSILON__)
assert(norm(array(quat_to_euler(q)) - array([phi, theta, psi])) < __FLT_EPSILON__)
assert(abs(norm(q) - 1) < FLT_EPSILON)
assert(abs(norm(q) - 1) < FLT_EPSILON)
assert(norm(array(quat_to_euler(q)) - array([phi, theta, psi])) < FLT_EPSILON)
print('\nq:')
pprint(q)
@@ -85,8 +85,8 @@ dcm = euler_to_dcm(phi, theta, psi)
assert(norm(dcm[:,0]) == 1)
assert(norm(dcm[:,1]) == 1)
assert(norm(dcm[:,2]) == 1)
assert(abs(dcm[:,0].dot(dcm[:,1])) < __FLT_EPSILON__)
assert(abs(dcm[:,0].dot(dcm[:,2])) < __FLT_EPSILON__)
assert(abs(dcm[:,0].dot(dcm[:,1])) < FLT_EPSILON)
assert(abs(dcm[:,0].dot(dcm[:,2])) < FLT_EPSILON)
print('\ndcm:')
pprint(dcm)