Skip to content

Commit 4c631fa

Browse files
committed
Speed up parent link indexes extraction
1 parent c8d6b53 commit 4c631fa

File tree

1 file changed

+3
-3
lines changed

1 file changed

+3
-3
lines changed

src/jaxsim/api/references.py

+3-3
Original file line numberDiff line numberDiff line change
@@ -492,9 +492,9 @@ def apply_frame_forces(
492492

493493
# Extract the frame indices.
494494
frame_idxs = js.frame.names_to_idxs(frame_names=frame_names, model=model)
495-
parent_link_idxs = jax.vmap(js.frame.idx_of_parent_link, in_axes=(None,))(
496-
model, frame_index=frame_idxs
497-
)
495+
parent_link_idxs = model.kin_dyn_parameters.frame_parameters.body[
496+
frame_idxs - model.number_of_links
497+
]
498498

499499
exceptions.raise_value_error_if(
500500
condition=~data.valid(model=model),

0 commit comments

Comments
 (0)