Variables | |
cfg = rs.config() | |
data = pose.get_pose_data() | |
frames = pipe.wait_for_frames() | |
pipe = rs.pipeline() | |
float | pitch = -m.asin(2.0 * (x*z - w*y))*180.0 |
pose = frames.get_pose_frame() | |
float | roll = m.atan2(2.0 * (w*x + y*z), w*w - x*x - y*y + z*z)*180.0 |
w = data.rotation.w | |
x = -data.rotation.z | |
y = data.rotation.x | |
float | yaw = m.atan2(2.0 * (w*z + x*y), w*w + x*x - y*y - z*z)*180.0 |
z = -data.rotation.y | |
t265_rpy.cfg = rs.config() |
Definition at line 18 of file t265_rpy.py.
t265_rpy.data = pose.get_pose_data() |
Definition at line 33 of file t265_rpy.py.
t265_rpy.frames = pipe.wait_for_frames() |
Definition at line 27 of file t265_rpy.py.
t265_rpy.pipe = rs.pipeline() |
Definition at line 15 of file t265_rpy.py.
t265_rpy.pose = frames.get_pose_frame() |
Definition at line 30 of file t265_rpy.py.
Definition at line 45 of file t265_rpy.py.
t265_rpy.w = data.rotation.w |
Definition at line 39 of file t265_rpy.py.
t265_rpy.x = -data.rotation.z |
Definition at line 40 of file t265_rpy.py.
t265_rpy.y = data.rotation.x |
Definition at line 41 of file t265_rpy.py.
Definition at line 46 of file t265_rpy.py.
t265_rpy.z = -data.rotation.y |
Definition at line 42 of file t265_rpy.py.