ceca51b0d8
Default humanoid intake to command-following gait and support bounded Cartesian target dragging for arms. Carry model and actuator semantics through calibration, native verification and packaging. Document reusable intake decisions and cover them with regression tests.
71 lines
3.3 KiB
Python
71 lines
3.3 KiB
Python
"""Train and replay agree on the range recorded in a template checkpoint."""
|
|
|
|
from dataclasses import replace
|
|
from pathlib import Path
|
|
|
|
import pytest
|
|
|
|
pytest.importorskip("mjlab")
|
|
|
|
from controller.input import deflections, scale, spans
|
|
from mjrl.replay import configure_velocity_replay
|
|
from tasks.robot_spec import JointSpec
|
|
from tasks.templates.Biped_Template.env_cfg import env_cfg
|
|
from tasks.templates.Wheeled_Biped_Template.env_cfg import env_cfg as wheeled_env_cfg
|
|
|
|
|
|
def test_training_range_matches_replay_at_each_checkpoint_level(neutral_robot):
|
|
train = env_cfg(neutral_robot)
|
|
params = train.curriculum["command"].params
|
|
axes = ("lin_vel_x", "lin_vel_y", "ang_vel_z")
|
|
ranges = train.commands["twist"].ranges
|
|
for axis, ceiling in zip(axes, params["ceilings"], strict=True):
|
|
cap = ceiling * params["fractions"][0]
|
|
assert getattr(ranges, axis) == pytest.approx((-cap, cap))
|
|
for level, fraction in enumerate(params["fractions"]):
|
|
replay = env_cfg(neutral_robot, play=True)
|
|
checkpoint = {"infos": {"curriculum": {"command": {"level": level}}}}
|
|
report = configure_velocity_replay(replay, train, checkpoint)
|
|
assert report["source"] == "checkpoint_curriculum"
|
|
for axis, ceiling in zip(axes, params["ceilings"], strict=True):
|
|
cap = ceiling * fraction
|
|
assert report["ranges"][axis] == pytest.approx([-cap, cap])
|
|
|
|
|
|
def test_the_operator_reaches_each_trained_limit(neutral_robot):
|
|
train = env_cfg(neutral_robot)
|
|
replay = env_cfg(neutral_robot, play=True)
|
|
params = train.curriculum["command"].params
|
|
level = len(params["fractions"]) - 1
|
|
checkpoint = {"infos": {"curriculum": {"command": {"level": level}}}}
|
|
report = configure_velocity_replay(replay, train, checkpoint)
|
|
command = replay.commands["twist"]
|
|
controls = command.controls
|
|
edges = spans(controls.command("twist"), command)
|
|
for axis, ceiling in zip(("lin_vel_x", "lin_vel_y", "ang_vel_z"), params["ceilings"], strict=True):
|
|
low, high = report["ranges"][axis]
|
|
cap = ceiling * params["fractions"][level]
|
|
assert (low, high) == pytest.approx((-cap, cap))
|
|
assert -ceiling <= low < high <= ceiling
|
|
for axis, (binding,) in controls.bindings.items():
|
|
values = dict.fromkeys(("Lx", "Ly", "Rx", "Ry", "LT", "RT"), 0.0)
|
|
values[binding.source] = binding.sign
|
|
positive = deflections(values, False, controls)[axis]
|
|
assert scale(positive, edges[axis]) == pytest.approx(report["ranges"][axis][1])
|
|
|
|
|
|
def test_wheeled_replay_rejects_lateral_commands(neutral_robot):
|
|
robot = replace(
|
|
neutral_robot, family="wheeled_biped",
|
|
model_path=Path(__file__).parents[1] / "assets/hybrid_wheeled_smoke/robot.xml",
|
|
foot_geoms=("left_tire", "right_tire"),
|
|
position_joints=(JointSpec("left_hip", 10, .6, 8, .2), JointSpec("right_hip", 10, .6, 8, .2)),
|
|
velocity_joints=(JointSpec("left_wheel_joint", 0, 1, 8, 3),
|
|
JointSpec("right_wheel_joint", 0, 1, 8, 3)),
|
|
)
|
|
train, play = wheeled_env_cfg(robot), wheeled_env_cfg(robot, play=True)
|
|
checkpoint = {"infos": {"curriculum": {"command": {"level": 2}}}}
|
|
assert configure_velocity_replay(play, train, checkpoint)["ranges"]["lin_vel_y"] == [0, 0]
|
|
with pytest.raises(ValueError, match="lin_vel_y"):
|
|
configure_velocity_replay(play, train, checkpoint, (0, 0.1, 0))
|