feat(device-plugins): add profiled K1 lifecycle and canonical data plane
This commit is contained in:
@@ -113,20 +113,10 @@ def test_decode_lio_pcl_rejects_unverified_or_unsafe_frames() -> None:
|
||||
|
||||
def test_decode_lio_pose() -> None:
|
||||
position = _fixed64(1, 1.25) + _fixed64(2, -2.5) + _fixed64(3, 3.75)
|
||||
orientation = (
|
||||
_fixed64(1, 0.1)
|
||||
+ _fixed64(2, 0.2)
|
||||
+ _fixed64(3, 0.3)
|
||||
+ _fixed64(4, 0.9)
|
||||
)
|
||||
orientation = _fixed64(1, 0.1) + _fixed64(2, 0.2) + _fixed64(3, 0.3) + _fixed64(4, 0.9)
|
||||
pose = _bytes(1, position) + _bytes(2, orientation)
|
||||
stamped = _sint(1, 987654321) + _bytes(2, pose)
|
||||
payload = (
|
||||
_bytes(1, _header())
|
||||
+ _bytes(2, stamped)
|
||||
+ _fixed32(3, 12.5)
|
||||
+ _fixed32(4, 0.001)
|
||||
)
|
||||
payload = _bytes(1, _header()) + _bytes(2, stamped) + _fixed32(3, 12.5) + _fixed32(4, 0.001)
|
||||
|
||||
frame = decode_lio_pose(payload)
|
||||
assert frame.pose_stamp == 987654321
|
||||
|
||||
Reference in New Issue
Block a user