@@ -38,17 +38,22 @@ def generate_test_description():
38
38
])
39
39
40
40
drive_base = launch_system_modes.actions.Node(
41
- package='system_modes_examples',
42
- executable='drive_base',
43
- name='drive_base',
44
- namespace='',
45
- output='screen')
41
+ package='system_modes_examples',
42
+ executable='drive_base',
43
+ name='drive_base',
44
+ namespace='',
45
+ output='screen')
46
46
47
47
# Startup
48
- drive_base_configure = launch.actions.EmitEvent(
49
- event=launch_ros.events.lifecycle.ChangeState(
50
- lifecycle_node_matcher=launch.events.matchers.matches_action(drive_base),
51
- transition_id=lifecycle_msgs.msg.Transition.TRANSITION_CONFIGURE))
48
+ drive_base_configure = launch.actions.TimerAction(
49
+ period=2.,
50
+ actions=[
51
+ launch.actions.EmitEvent(
52
+ event=launch_ros.events.lifecycle.ChangeState(
53
+ lifecycle_node_matcher=launch.events.matchers.matches_action(drive_base),
54
+ transition_id=lifecycle_msgs.msg.Transition.TRANSITION_CONFIGURE))
55
+ ]
56
+ )
52
57
53
58
drive_base_activate = launch.actions.EmitEvent(
54
59
event=launch_ros.events.lifecycle.ChangeState(
@@ -88,13 +93,13 @@ def generate_test_description():
88
93
entities=[drive_base_change_mode_to_FAST]))
89
94
90
95
launch_description = LaunchDescription()
96
+ launch_description.add_action(mode_manager)
97
+ launch_description.add_action(drive_base)
91
98
launch_description.add_action(on_inactive_handler)
92
99
launch_description.add_action(on_active_handler)
93
100
launch_description.add_action(on_DEFAULT_mode)
94
- launch_description.add_action(mode_manager)
95
101
launch_description.add_action(launch_testing.util.KeepAliveProc())
96
102
launch_description.add_action(launch_testing.actions.ReadyToTest())
97
- launch_description.add_action(drive_base)
98
103
launch_description.add_action(drive_base_configure)
99
104
100
105
return launch_description, locals()
@@ -116,9 +121,6 @@ class TestModeManagement(unittest.TestCase):
116
121
timeout=15
117
122
)
118
123
119
- import time
120
- time.sleep(1)
121
-
122
124
@launch_testing.post_shutdown_test()
123
125
class TestModeManagementShutdown(unittest.TestCase):
124
126
0 commit comments