@@ -24,10 +24,10 @@ def setup_statemachine(robot):
2424
2525 skip_door = rospy .get_param ("~skip_door" , False )
2626 skip_inspect = rospy .get_param ("~skip inspect" , False )
27- shelfDes = ds .EntityByIdDesignator (robot , uuid = challenge_knowledge .shelf )
28- tableDes = ds .EntityByIdDesignator (robot , uuid = challenge_knowledge .table )
29- objectsDes = ds .VariableDesignator (resolve_type = [ClassificationResult ])
30- roomDes = ds .EntityByIdDesignator (robot , challenge_knowledge .room , name = "room_designator" )
27+ shelf_des = ds .EntityByIdDesignator (robot , uuid = challenge_knowledge .shelf )
28+ table_des = ds .EntityByIdDesignator (robot , uuid = challenge_knowledge .table )
29+ objects_des = ds .VariableDesignator (resolve_type = [ClassificationResult ])
30+ room_des = ds .EntityByIdDesignator (robot , challenge_knowledge .room , name = "room_designator" )
3131
3232 with state_machine :
3333
@@ -44,7 +44,7 @@ def setup_statemachine(robot):
4444
4545 # open the door of the cabinet
4646 smach .StateMachine .add ("OPEN_DOOR" ,
47- OpenDoorMachine (robot , shelfDes ),
47+ OpenDoorMachine (robot , shelf_des ),
4848 transitions = {'succeeded' : 'SAY_CLOSE_DOOR' ,
4949 'failed' : 'SAY_UNABLE_TO_OPEN_DOOR' })
5050
@@ -61,8 +61,8 @@ def setup_statemachine(robot):
6161 # Inspect shelf
6262 smach .StateMachine .add ("NAV_TO_START" ,
6363 states .navigation .NavigateToSymbolic (robot ,
64- {shelfDes : "in_front_of" },
65- shelfDes , room = roomDes ),
64+ {shelf_des : "in_front_of" },
65+ shelf_des , room = room_des ),
6666 transitions = {'arrived' : 'SKIP_INSPECT' ,
6767 'unreachable' : 'SKIP_INSPECT' ,
6868 'goal_not_defined' : 'SKIP_INSPECT' })
@@ -73,7 +73,7 @@ def setup_statemachine(robot):
7373 'false' : 'INSPECT_SHELVES' })
7474
7575 smach .StateMachine .add ("INSPECT_SHELVES" ,
76- InspectAreas (robot , shelfDes , objectsDes , roomDes , knowledge = challenge_knowledge ,
76+ InspectAreas (robot , shelf_des , objects_des , room_des , knowledge = challenge_knowledge ,
7777 navigation_area = 'in_front_of' ),
7878 transitions = {'done' : 'RESET_ARM' ,
7979 'failed' : 'Failed' })
@@ -90,7 +90,7 @@ def reset_arm(userdata=None):
9090
9191 # store items
9292 smach .StateMachine .add ("STORE_GROCERIES" ,
93- StoreItems (robot , tableDes , shelfDes , objectsDes , challenge_knowledge , room = roomDes ),
93+ StoreItems (robot , table_des , shelf_des , objects_des , challenge_knowledge , room = room_des ),
9494 transitions = {'succeeded' : 'AT_END' ,
9595 'preempted' : 'Aborted' ,
9696 'failed' : 'Failed' }
0 commit comments