|
LIRRA
1.0.0
|
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) |
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.
| 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.
| jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_conj | ( | jnp.ndarray | q | ) |
| jnp.ndarray rl_stl.envs.skydio_x2.frames.quat_from_axis_angle | ( | jnp.ndarray | axis, |
| jnp.ndarray | angle | ||
| ) |
| 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).
| 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``).
| 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]``.
| jnp.ndarray rl_stl.envs.skydio_x2.frames.rotate | ( | jnp.ndarray | q, |
| jnp.ndarray | v_body | ||
| ) |
Body-frame vector -> world frame.
| jnp.ndarray rl_stl.envs.skydio_x2.frames.rotate_inv | ( | jnp.ndarray | q, |
| jnp.ndarray | v_world | ||
| ) |
World-frame vector -> body frame.
| 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).
| 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).
| jnp.ndarray rl_stl.envs.skydio_x2.frames.skew | ( | jnp.ndarray | v | ) |
| jnp.ndarray rl_stl.envs.skydio_x2.frames.tilt_cosine | ( | jnp.ndarray | q | ) |
cos(angle between body z and world z) = R[2, 2].
| jnp.ndarray rl_stl.envs.skydio_x2.frames.vee | ( | jnp.ndarray | S | ) |