feat(msgs): add PointStamped geometry message type (#1388)

* feat(msgs): add PointStamped geometry message type

adds geometry_msgs.PointStamped following the PoseStamped pattern:
- inherits from dimos_lcm PointStamped + Timestamped mixin
- lcm_encode/lcm_decode for binary roundtrip
- to_rerun() → rr.Points3D
- to_pose_stamped() → PoseStamped with identity orientation
- plum.dispatch constructors (x/y/z, Vector3, list, kwargs)
- conforms to DimosMsg protocol
- 30 unit tests

enables the rerun viewer click-to-navigate pipeline: viewer publishes
PointStamped to /clicked_point via LCM, any module subscribes via
LCMTransport and converts to PoseStamped for navigation.

DIM-643

* CI code cleanup

* refactor(msgs): drop plum.dispatch, use Point(LCMPoint) base

- replace multi-dispatch constructors with single __init__(x, y, z, ts, frame_id)
- inherit from Point(LCMPoint) instead of Vector3(LCMVector3)
- add Point wrapper class for geometry_msgs.Point
- simplify tests to focus on LCM roundtrip per review feedback

addresses review comments from leshy on PR #1388

* test(msgs): simplify PointStamped tests to match TwistStamped pattern

3 focused tests: lcm roundtrip, Point inheritance, PoseStamped conversion

* style(msgs): ruff format and lint fixes

* refactor(msgs): use Timestamped.ros_timestamp() instead of local sec_nsec

* refactor(msgs): move Point to separate file

Point is a separate LCM message type, should have its own file
like Vector3, Quaternion, Pose, etc.

* fix(msgs): resolve mypy errors in Point/PointStamped

- add type: ignore[misc] for LCMPoint subclass (generated code has Any type)
- add PoseStamped to TYPE_CHECKING import block
- fix test import: Point from Point module, not PointStamped module

---------

Co-authored-by: spomichter <12108168+spomichter@users.noreply.github.com>

Author: spomichter

dimos/msgs/geometry_msgs/Point.py

@@ -0,0 +1,33 @@
+# Copyright 2025-2026 Dimensional Inc.
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+#     http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+from __future__ import annotations
+
+from dimos_lcm.geometry_msgs import Point as LCMPoint
+
+
+class Point(LCMPoint):  # type: ignore[misc]
+    """DimOS wrapper for geometry_msgs.Point (3D position).
+
+    Inherits x/y/z from LCMPoint. Wire-identical to Vector3 but
+    semantically represents a position, not a direction/displacement.
+    """
+
+    msg_name = "geometry_msgs.Point"
+
+    def __init__(self, x: float = 0.0, y: float = 0.0, z: float = 0.0) -> None:
+        super().__init__(float(x), float(y), float(z))
+
+    def __repr__(self) -> str:
+        return f"Point(x={self.x}, y={self.y}, z={self.z})"

dimos/msgs/geometry_msgs/PointStamped.py

@@ -0,0 +1,102 @@
+# Copyright 2025-2026 Dimensional Inc.
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+#     http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+from __future__ import annotations
+
+import time
+from typing import TYPE_CHECKING, BinaryIO
+
+if TYPE_CHECKING:
+    from rerun._baseclasses import Archetype
+
+    from dimos.msgs.geometry_msgs.PoseStamped import PoseStamped
+
+from dimos_lcm.geometry_msgs import PointStamped as LCMPointStamped
+
+from dimos.msgs.geometry_msgs.Point import Point
+from dimos.types.timestamped import Timestamped
+
+
+class PointStamped(Point, Timestamped):
+    """A 3D point with timestamp and frame_id.
+
+    Follows the same pattern as PoseStamped(Pose, Timestamped) and
+    TwistStamped(Twist, Timestamped). Inherits x/y/z from Point
+    (which inherits from LCMPoint).
+    """
+
+    msg_name = "geometry_msgs.PointStamped"
+    ts: float
+    frame_id: str
+
+    def __init__(
+        self,
+        x: float = 0.0,
+        y: float = 0.0,
+        z: float = 0.0,
+        ts: float = 0.0,
+        frame_id: str = "",
+    ) -> None:
+        self.frame_id = frame_id
+        self.ts = ts if ts != 0 else time.time()
+        super().__init__(float(x), float(y), float(z))
+
+    # -- LCM encode / decode --
+
+    def lcm_encode(self) -> bytes:
+        """Encode to LCM binary format."""
+        lcm_msg = LCMPointStamped()
+        lcm_msg.point = self  # Works because Point inherits from LCMPoint
+        [lcm_msg.header.stamp.sec, lcm_msg.header.stamp.nsec] = self.ros_timestamp()
+        lcm_msg.header.frame_id = self.frame_id
+        return lcm_msg.lcm_encode()  # type: ignore[no-any-return]
+
+    @classmethod
+    def lcm_decode(cls, data: bytes | BinaryIO) -> PointStamped:
+        """Decode from LCM binary format."""
+        lcm_msg = LCMPointStamped.lcm_decode(data)
+        return cls(
+            x=lcm_msg.point.x,
+            y=lcm_msg.point.y,
+            z=lcm_msg.point.z,
+            ts=lcm_msg.header.stamp.sec + (lcm_msg.header.stamp.nsec / 1_000_000_000),
+            frame_id=lcm_msg.header.frame_id,
+        )
+
+    # -- Conversion methods --
+
+    def to_rerun(self) -> Archetype:
+        """Convert to rerun Points3D archetype for visualization."""
+        import rerun as rr
+
+        return rr.Points3D(positions=[[self.x, self.y, self.z]])
+
+    def to_pose_stamped(self) -> PoseStamped:
+        """Convert to PoseStamped with identity quaternion orientation."""
+        from dimos.msgs.geometry_msgs.PoseStamped import PoseStamped
+
+        return PoseStamped(
+            ts=self.ts,
+            frame_id=self.frame_id,
+            position=[self.x, self.y, self.z],
+            orientation=[0.0, 0.0, 0.0, 1.0],
+        )
+
+    # -- String representations --
+
+    def __str__(self) -> str:
+        return f"PointStamped(point=[{self.x:.3f}, {self.y:.3f}, {self.z:.3f}], frame_id={self.frame_id!r})"
+
+    def __repr__(self) -> str:
+        return f"PointStamped(x={self.x}, y={self.y}, z={self.z}, ts={self.ts}, frame_id={self.frame_id!r})"

dimos/msgs/geometry_msgs/__init__.py

@@ -1,3 +1,5 @@
+from dimos.msgs.geometry_msgs.Point import Point
+from dimos.msgs.geometry_msgs.PointStamped import PointStamped
 from dimos.msgs.geometry_msgs.Pose import Pose, PoseLike, to_pose
 from dimos.msgs.geometry_msgs.PoseArray import PoseArray
 from dimos.msgs.geometry_msgs.PoseStamped import PoseStamped
@@ -14,6 +16,8 @@
 from dimos.msgs.geometry_msgs.WrenchStamped import WrenchStamped
 
 __all__ = [
+    "Point",
+    "PointStamped",
     "Pose",
     "PoseArray",
     "PoseLike",

dimos/msgs/geometry_msgs/test_PointStamped.py

@@ -0,0 +1,64 @@
+# Copyright 2025-2026 Dimensional Inc.
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+#     http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+"""Tests for geometry_msgs.PointStamped — msg -> lcm bytes -> msg roundtrip."""
+
+import time
+
+from dimos_lcm.geometry_msgs import Point as LCMPoint
+
+from dimos.msgs.geometry_msgs.Point import Point
+from dimos.msgs.geometry_msgs.PointStamped import PointStamped
+
+
+def test_point_inherits_lcm() -> None:
+    """Point wrapper inherits from LCMPoint."""
+    assert isinstance(Point(1.0, 2.0, 3.0), LCMPoint)
+
+
+def test_lcm_encode_decode() -> None:
+    """Test encoding and decoding of PointStamped to/from binary LCM format."""
+    source = PointStamped(
+        x=1.5,
+        y=-2.5,
+        z=3.5,
+        ts=time.time(),
+        frame_id="/world/grid",
+    )
+    binary_msg = source.lcm_encode()
+    dest = PointStamped.lcm_decode(binary_msg)
+
+    assert isinstance(dest, PointStamped)
+    assert dest is not source
+    assert dest.x == source.x
+    assert dest.y == source.y
+    assert dest.z == source.z
+    assert abs(dest.ts - source.ts) < 1e-6
+    assert dest.frame_id == source.frame_id
+
+
+def test_to_pose_stamped() -> None:
+    """Test conversion to PoseStamped with identity orientation."""
+    from dimos.msgs.geometry_msgs.PoseStamped import PoseStamped
+
+    pt = PointStamped(x=1.0, y=2.0, z=3.0, ts=500.0, frame_id="/map")
+    pose = pt.to_pose_stamped()
+
+    assert isinstance(pose, PoseStamped)
+    assert pose.x == 1.0
+    assert pose.y == 2.0
+    assert pose.z == 3.0
+    assert pose.orientation.w == 1.0
+    assert pose.ts == 500.0
+    assert pose.frame_id == "/map"