feat(device-plugins): add profiled K1 lifecycle and canonical data plane
This commit is contained in:
@@ -77,15 +77,9 @@ def _pcl_payload(*, scaler: int, point_count: int) -> bytes:
|
||||
|
||||
def _pose_payload(position_xyz: tuple[float, float, float]) -> bytes:
|
||||
position = b"".join(
|
||||
_fixed64(field_number, value)
|
||||
for field_number, value in enumerate(position_xyz, start=1)
|
||||
)
|
||||
orientation = (
|
||||
_fixed64(1, 0.0)
|
||||
+ _fixed64(2, 0.0)
|
||||
+ _fixed64(3, 0.0)
|
||||
+ _fixed64(4, 1.0)
|
||||
_fixed64(field_number, value) for field_number, value in enumerate(position_xyz, start=1)
|
||||
)
|
||||
orientation = _fixed64(1, 0.0) + _fixed64(2, 0.0) + _fixed64(3, 0.0) + _fixed64(4, 1.0)
|
||||
pose = _bytes(1, position) + _bytes(2, orientation)
|
||||
stamped = _sint(1, 987654321) + _bytes(2, pose)
|
||||
return _bytes(1, _header(scaler=1000)) + _bytes(2, stamped)
|
||||
|
||||
Reference in New Issue
Block a user