Skip to content

Commit e5cb22c

Browse files
authored
enable isForkliftLoadDetected condition node (ros-navigation#234)
* enable isForkliftLoadDetected condition node * use check_forklift_load_state argument and remove wait
1 parent 8e4ff8d commit e5cb22c

File tree

4 files changed

+4
-9
lines changed

4 files changed

+4
-9
lines changed

nav2_bt_navigator/behavior_trees/pallet_pickup.xml

Lines changed: 1 addition & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -7,10 +7,7 @@
77
<BehaviorTree ID="PalletPickUpMasterBT">
88
<RetryUntilSuccessful num_attempts="2">
99
<Sequence>
10-
<!-- <Wait wait_duration="2"/>
11-
<Inverter>
12-
<isForkliftLoadDetected/>
13-
</Inverter> -->
10+
<isForkliftLoadDetected check_forklift_load_state="empty"/>
1411
<Fallback>
1512
<Sequence>
1613
<AGVCloseToPallet goal="{goal}" pallet_id="{pallet_id}"/>

nav2_bt_navigator/behavior_trees/pallet_pickup_without_obstacles.xml

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -49,7 +49,7 @@
4949
</RecoveryNode>
5050
<AlwaysSuccess/>
5151
</Fallback>
52-
<!--<isForkliftLoadDetected/>-->
52+
<isForkliftLoadDetected check_forklift_load_state="loaded"/>
5353
<SetLiftLevel lift_level="lifted_low" wait_for_lift="True" lift_timeout="10.0"/>
5454
<Parallel name="lift while backup" failure_threshold="1" success_threshold="2">
5555
<BackUp backup_dist="1.8" backup_speed="0.3"/>

nav2_bt_navigator/behavior_trees/pallet_pickup_without_obstacles_and_lidar.xml

Lines changed: 1 addition & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -28,8 +28,7 @@
2828
</RetryUntilSuccessful>
2929
<CallService service_name="stop_barcode_scanning_1"/>
3030
<CallService service_name="stop_barcode_scanning_2"/>
31-
<!-- After forklift publisher will be operated, node below should be uncommented -->
32-
<!-- <isForkliftLoadDetected/> -->
31+
<isForkliftLoadDetected check_forklift_load_state="loaded"/>
3332
<SetLiftLevel lift_level="lifted_low"/>
3433
</Sequence>
3534
</ReactiveSequence>

nav2_bt_navigator/behavior_trees/pallet_putdown.xml

Lines changed: 1 addition & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -6,8 +6,7 @@
66
<BehaviorTree ID="PalletPutDownMasterBT">
77
<RetryUntilSuccessful num_attempts="2">
88
<Sequence>
9-
<!-- <Wait wait_duration="2"/>
10-
<isForkliftLoadDetected/> -->
9+
<isForkliftLoadDetected check_forklift_load_state="loaded"/>
1110
<Fallback name="leave bin">
1211
<Sequence name="leave the bin">
1312
<!-- add_narrow_exit_waypoint-->

0 commit comments

Comments
 (0)