36 if 'rclpy' in sys.modules
and hasattr(sys.modules[
'rclpy'],
'_mirs_stub'):
38 rclpy = types.ModuleType(
'rclpy')
39 rclpy._mirs_stub =
True
40 rclpy.init =
lambda *a, **k:
None
41 rclpy.spin =
lambda *a, **k:
None
42 rclpy.shutdown =
lambda *a, **k:
None
44 node_mod = types.ModuleType(
'rclpy.node')
47 def __init__(self, name):
49 self._params = {
'frame_id':
'odom'}
51 def declare_parameter(self, name, value):
52 self._params[name] = value
54 def get_parameter(self, name):
56 m.value = self._params[name]
59 def create_publisher(self, *a, **k):
63 m.publish =
lambda msg: (m.published.append(msg), orig(msg))
66 def create_subscription(self, *a, **k):
72 def destroy_node(self):
78 nav_msgs = types.ModuleType(
'nav_msgs')
79 nav_msgs_msg = types.ModuleType(
'nav_msgs.msg')
82 def __init__(self, x=0.0, y=0.0):
86 def __init__(self, x=0.0, y=0.0):
87 self.position = _Pos(x, y)
94 self.header = MagicMock()
99 self.header = MagicMock()
102 nav_msgs_msg.Odometry = Odometry
103 nav_msgs_msg.Path = Path
104 nav_msgs_msg.PoseStamped = PoseStamped
106 geom = types.ModuleType(
'geometry_msgs')
107 geom_msg = types.ModuleType(
'geometry_msgs.msg')
108 geom_msg.PoseStamped = PoseStamped
110 sys.modules[
'rclpy'] = rclpy
111 sys.modules[
'rclpy.node'] = node_mod
112 sys.modules[
'nav_msgs'] = nav_msgs
113 sys.modules[
'nav_msgs.msg'] = nav_msgs_msg
114 sys.modules[
'geometry_msgs'] = geom
115 sys.modules[
'geometry_msgs.msg'] = geom_msg
139 node = _mod.TrajectoryPublisher.__new__(_mod.TrajectoryPublisher)
141 a.position.x, a.position.y = 0.0, 0.0
143 b.position.x, b.position.y = 3.0, 4.0
144 assert node.calculate_distance(a, b) == 5.0