LIRRA  1.0.0
Loading...
Searching...
No Matches
rl_stl.dynamics.quadrotor_fsyn Namespace Reference

Classes

class  DoubleIntegrator3D
 
class  FsynConfig
 

Functions

tuple[np.ndarray, np.ndarray] accel_box_from_limits (X2Params x2, FsynConfig cfg)
 
DoubleIntegrator3D make_fsyn (X2Params x2, FsynConfig cfg=FsynConfig())
 
np.ndarray fsyn_state_from_mujoco (X2Params x2, np.ndarray qpos, np.ndarray qvel)
 
tuple[np.ndarray, np.ndarray] mujoco_state_from_fsyn (X2Params x2, np.ndarray z, np.ndarray quat=(1.0, 0.0, 0.0, 0.0), np.ndarray w_body=(0.0, 0.0, 0.0))
 

Variables

str FSYN_VERSION = "fsyn_di3d_v1"
 

Detailed Description

Reduced-order synthesis model ``f_syn`` v1 for the Skydio X2: 3-D double integrator.

State ``z = [p_com (3), v_com (3)]`` in the world frame (COM position and velocity),
input ``u = a_com`` (3, world-frame COM acceleration excluding gravity), exact
zero-order-hold discretization at the synthesis step ``dt``::

    z+ = A z + B u,   A = [[I, dt I], [0, I]],   B = [[dt^2/2 I], [dt I]]

The stlpy output is ``y = [p, v, u]`` (9-D), mirroring ``stlpy.systems.DoubleIntegrator``.

Input bounds are a box ``a_min <= u <= a_max`` chosen *inside* the set of COM
accelerations the X2 can produce at quasi-steady attitude:

- thrust vector per unit mass ``f = u + g e_z`` must have tilt ``<= tilt_max``;
  the worst case is the smallest vertical component, so
  ``a_xy <= (g - a_down) tan(tilt_max) / sqrt(2)`` (both horizontal axes at the
  box corner simultaneously);
- ``|f| <= headroom * T_max / m`` so that ``1 - headroom`` of the collective range
  stays available for attitude control;
- ``g - a_down >= T_min / m``.

These are necessary conditions for tracking, not a proof: attitude/rate transients,
motor saturation and fluid drag create mismatch that is measured by
``experiments/reduced_quadrotor/fsyn_mismatch.py`` and must be represented as a
bounded disturbance before any guarantee is claimed.

Function Documentation

◆ accel_box_from_limits()

tuple[np.ndarray, np.ndarray] rl_stl.dynamics.quadrotor_fsyn.accel_box_from_limits ( X2Params  x2,
FsynConfig  cfg 
)

◆ fsyn_state_from_mujoco()

np.ndarray rl_stl.dynamics.quadrotor_fsyn.fsyn_state_from_mujoco ( X2Params  x2,
np.ndarray  qpos,
np.ndarray  qvel 
)
MuJoCo free-joint state -> ``z = [p_com, v_com]`` (world).

◆ make_fsyn()

DoubleIntegrator3D rl_stl.dynamics.quadrotor_fsyn.make_fsyn ( X2Params  x2,
FsynConfig   cfg = FsynConfig() 
)

◆ mujoco_state_from_fsyn()

tuple[np.ndarray, np.ndarray] rl_stl.dynamics.quadrotor_fsyn.mujoco_state_from_fsyn ( X2Params  x2,
np.ndarray  z,
np.ndarray   quat = (1.0, 0.0, 0.0, 0.0),
np.ndarray   w_body = (0.0, 0.0, 0.0) 
)
``z`` plus attitude/body rates -> free-joint ``qpos (7)``, ``qvel (6)`` (exact inverse).

Variable Documentation

◆ FSYN_VERSION

str rl_stl.dynamics.quadrotor_fsyn.FSYN_VERSION = "fsyn_di3d_v1"