LIRRA  1.0.0
Loading...
Searching...
No Matches
rl_stl.envs.skydio_x2.frames Namespace Reference

Functions

jnp.ndarray quat_to_rotmat (jnp.ndarray q)
 
jnp.ndarray rotmat_to_quat (jnp.ndarray R)
 
jnp.ndarray quat_mul (jnp.ndarray a, jnp.ndarray b)
 
jnp.ndarray quat_conj (jnp.ndarray q)
 
jnp.ndarray quat_from_axis_angle (jnp.ndarray axis, jnp.ndarray angle)
 
jnp.ndarray quat_from_euler_zyx (jnp.ndarray roll, jnp.ndarray pitch, jnp.ndarray yaw)
 
jnp.ndarray rotmat_to_euler_zyx (jnp.ndarray R)
 
jnp.ndarray rotate (jnp.ndarray q, jnp.ndarray v_body)
 
jnp.ndarray rotate_inv (jnp.ndarray q, jnp.ndarray v_world)
 
jnp.ndarray tilt_cosine (jnp.ndarray q)
 
jnp.ndarray skew (jnp.ndarray v)
 
jnp.ndarray vee (jnp.ndarray S)
 
jnp.ndarray point_velocity_world (jnp.ndarray q, jnp.ndarray v_origin_world, jnp.ndarray w_body, jnp.ndarray r_body)
 

Detailed Description

Rotation and frame conventions shared by the X2 environment, controllers and tests.

Conventions (identical to MuJoCo, verified in ``tests/test_frames.py``):

- Quaternions are ``q = [w, x, y, z]`` (scalar first), unit norm, and rotate
  **body -> world**: ``v_world = R(q) @ v_body``.
- World frame is ENU-like with ``+z`` up and gravity ``[0, 0, -9.81]``.
- Body frame of the X2: ``+x`` forward (towards rotors 3/4), ``+y`` left, ``+z``
  up along the thrust direction.
- Free-joint ``qvel[0:3]`` is the **world-frame** linear velocity of the body
  frame origin; ``qvel[3:6]`` is the **body-frame** angular velocity (this is what
  the gyro measures).
- Euler angles, when used for logging only, are intrinsic Z-Y-X (yaw, pitch, roll).

All functions are pure ``jax.numpy`` and work under ``jit``/``vmap``; they also
accept NumPy arrays.

Function Documentation

◆ point_velocity_world()

jnp.ndarray rl_stl.envs.skydio_x2.frames.point_velocity_world ( jnp.ndarray  q,
jnp.ndarray  v_origin_world,
jnp.ndarray  w_body,
jnp.ndarray   r_body 
)
World velocity of a body-fixed point at ``r_body`` from free-joint velocities.

◆ quat_conj()

jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_conj ( jnp.ndarray  q)

◆ quat_from_axis_angle()

jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_from_axis_angle ( jnp.ndarray  axis,
jnp.ndarray  angle 
)

◆ quat_from_euler_zyx()

jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_from_euler_zyx ( jnp.ndarray  roll,
jnp.ndarray  pitch,
jnp.ndarray  yaw 
)
Quaternion for intrinsic yaw (z), then pitch (y), then roll (x).

◆ quat_mul()

jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_mul ( jnp.ndarray  a,
jnp.ndarray  b 
)
Hamilton product ``a * b`` (apply ``b`` first, then ``a``).

◆ quat_to_rotmat()

jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_to_rotmat ( jnp.ndarray  q)
Rotation matrix (body -> world) from a unit quaternion ``[w, x, y, z]``.

◆ rotate()

jnp.ndarray rl_stl.envs.skydio_x2.frames.rotate ( jnp.ndarray  q,
jnp.ndarray  v_body 
)
Body-frame vector -> world frame.

◆ rotate_inv()

jnp.ndarray rl_stl.envs.skydio_x2.frames.rotate_inv ( jnp.ndarray  q,
jnp.ndarray  v_world 
)
World-frame vector -> body frame.

◆ rotmat_to_euler_zyx()

jnp.ndarray rl_stl.envs.skydio_x2.frames.rotmat_to_euler_zyx ( jnp.ndarray  R)
``[roll, pitch, yaw]`` for ``R = Rz(yaw) Ry(pitch) Rx(roll)`` (logging only; singular at |pitch|=pi/2).

◆ rotmat_to_quat()

jnp.ndarray rl_stl.envs.skydio_x2.frames.rotmat_to_quat ( jnp.ndarray  R)
Unit quaternion ``[w, x, y, z]`` with ``w >= 0`` from a rotation matrix (branch-free).

◆ skew()

jnp.ndarray rl_stl.envs.skydio_x2.frames.skew ( jnp.ndarray  v)

◆ tilt_cosine()

jnp.ndarray rl_stl.envs.skydio_x2.frames.tilt_cosine ( jnp.ndarray  q)
cos(angle between body z and world z) = R[2, 2].

◆ vee()

jnp.ndarray rl_stl.envs.skydio_x2.frames.vee ( jnp.ndarray  S)