 Please ask about problems and questions regarding this tutorial on answers.ros.org. Don't forget to include in your question the link to this page, the versions of your OS & ROS, and also add appropriate tags. |
并行状态机
Description: 本教程展示了一个并行运行两个状态的示例。Tutorial Level: BEGINNER
Next Tutorial: 简单行为状态
所有下面的示例都可以在不修改的情况下运行。它们可以在示例目录中的smach_tutorials包中找到。每个文件头部的注释大致显示了运行脚本的输出应该是什么样的。
1 #!/usr/bin/env python
2
3 import roslib; roslib.load_manifest('smach_tutorials')
4 import rospy
5 import smach
6 import smach_ros
7
8 # define state Foo
9 class Foo(smach.State):
10 def __init__(self):
11 smach.State.__init__(self, outcomes=['outcome1','outcome2'])
12 self.counter = 0
13
14 def execute(self, userdata):
15 rospy.loginfo('Executing state FOO')
16 if self.counter < 3:
17 self.counter += 1
18 return 'outcome1'
19 else:
20 return 'outcome2'
21
22
23 # define state Bar
24 class Bar(smach.State):
25 def __init__(self):
26 smach.State.__init__(self, outcomes=['outcome1'])
27
28 def execute(self, userdata):
29 rospy.loginfo('Executing state BAR')
30 return 'outcome1'
31
32
33
34 # define state Bas
35 class Bas(smach.State):
36 def __init__(self):
37 smach.State.__init__(self, outcomes=['outcome3'])
38
39 def execute(self, userdata):
40 rospy.loginfo('Executing state BAS')
41 return 'outcome3'
42
43
44
45
46 def main():
47 rospy.init_node('smach_example_state_machine')
48
49 # Create the top level SMACH state machine
50 sm_top = smach.StateMachine(outcomes=['outcome6'])
51
52 # Open the container
53 with sm_top:
54
55 smach.StateMachine.add('BAS', Bas(),
56 transitions={'outcome3':'CON'})
57
58 # Create the sub SMACH state machine
59 sm_con = smach.Concurrence(outcomes=['outcome4','outcome5'],
60 default_outcome='outcome4',
61 outcome_map={'outcome5':
62 { 'FOO':'outcome2',
63 'BAR':'outcome1'}})
64
65 # Open the container
66 with sm_con:
67 # Add states to the container
68 smach.Concurrence.add('FOO', Foo())
69 smach.Concurrence.add('BAR', Bar())
70
71 smach.StateMachine.add('CON', sm_con,
72 transitions={'outcome4':'CON',
73 'outcome5':'outcome6'})
74
75 # Execute SMACH plan
76 outcome = sm_top.execute()
77
78
79 if __name__ == '__main__':
80 main()
