Fix MJX contact sensor.
PiperOrigin-RevId: 791317188 Change-Id: I97e2020f99742d9bb3cb798d4b5354b51fdda2e2
This commit is contained in:
committed by
Copybara-Service
parent
784c7a419b
commit
3821ff1dcf
@@ -684,7 +684,7 @@ def sensor_acc(m: Model, d: Data) -> Data:
|
|||||||
slot.append(flip[:, 2, None] * d._impl.contact.frame[cid, 1])
|
slot.append(flip[:, 2, None] * d._impl.contact.frame[cid, 1])
|
||||||
|
|
||||||
found = is_contact[cid] & match
|
found = is_contact[cid] & match
|
||||||
sensors.append((found[:, None] * np.hstack(slot)).reshape(-1))
|
sensors.append((found[:, None] * jp.hstack(slot)).reshape(-1))
|
||||||
adrs.append(
|
adrs.append(
|
||||||
(adr[idx_ds][:, None] + np.arange(num * size)[None]).reshape(-1)
|
(adr[idx_ds][:, None] + np.arange(num * size)[None]).reshape(-1)
|
||||||
)
|
)
|
||||||
|
|||||||
Reference in New Issue
Block a user