|
LIRRA
1.0.0
|
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" |
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.
| tuple[np.ndarray, np.ndarray] rl_stl.dynamics.quadrotor_fsyn.accel_box_from_limits | ( | X2Params | x2, |
| FsynConfig | cfg | ||
| ) |
| 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).
| DoubleIntegrator3D rl_stl.dynamics.quadrotor_fsyn.make_fsyn | ( | X2Params | x2, |
| FsynConfig | cfg = FsynConfig() |
||
| ) |
| 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).
| str rl_stl.dynamics.quadrotor_fsyn.FSYN_VERSION = "fsyn_di3d_v1" |