Pimpest/toid
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Final changes for homologation

Browse Source
This commit is contained in:
Pimpest
2026-04-17 11:22:07 +02:00
parent d09294c1a5
commit d26adb576a
5 changed files with 49 additions and 49 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
toid_bot_description/src/toid_bot_description.urdf
View File

@@ -73,7 +73,7 @@
<joint name="lidar_joint" type="fixed">
<parent link="base_link"/>
<child link="lidar"/>
<origin xyz="${lidar_xoff} 0 ${(base_height + lidar_height)/2}" rpy="0 0 0"/>
<origin xyz="${lidar_xoff} 0 ${(base_height + lidar_height)/2}" rpy="0 0 ${pi}"/>
</joint>

54
toid_bt/behavior_trees/behavior1.xml
View File

@@ -15,39 +15,35 @@
<BehaviorTree ID="seq1">
<Sequence>
<ZeroOdom service_name=""/>
<MovePointSimple x="0.1"
y="0"
theta="0"
max_speed="0.350000"
<SetInitialPose y="0.805"
theta="-90"
frame_id="map"
x="1.325"
topic_name="__default__placeholder__"/>
<WaitPullPin action_name=""/>
<InPose timeout="1.000000">
<MovePointSimple x="1.325"
y="0.200"
theta="-90"
max_speed="0.200000"
backwards="false"
action_name=""/>
<RotateTowards x="0.76"
y="-0.5"
max_speed="1.50000"
min_angle="0.000000"
action_name=""/>
<MovePointSimple x="0.756"
y="-0.5"
theta="-45"
max_speed="0.350000"
</InPose>
<Seq1 service_name=""/>
<Seq2 text=""
service_name=""/>
<MovePointSimple x="1.325"
y="-0.05"
theta="-90"
max_speed="0.200000"
backwards="false"
action_name=""/>
<RotateTowards x="0.76"
y="-0.02"
max_speed="1.50000"
min_angle="0.000000"
action_name=""/>
<MovePointSimple x="0.757"
y="-0.02"
theta="90"
max_speed="0.150000"
backwards="false"
action_name=""/>
<MovePointSimple x="1.2"
y="0.0"
theta="0.0"
max_speed="0.250000"
backwards="false"
<Seq3 service_name=""/>
<MovePointSimple x="1.325"
y="0.805"
theta="-90"
max_speed="0.200000"
backwards="true"
action_name=""/>
</Sequence>
</BehaviorTree>

21
toid_bt/behavior_trees/calibration_routines.xml
View File

@@ -4,6 +4,7 @@
<Sequence>
<SetBlackboard value="0.265"
output_key="width"/>
<WaitPullPin />
<Sleep msec="1000"/>
<ZeroOdom service_name=""/>
<RotateTowards x="0.4"
@@ -46,52 +47,53 @@
<Sequence>
<Sleep msec="5000"/>
<ZeroOdom service_name=""/>
<WaitPullPin />
<Sleep msec="1000"/>
<Repeat num_cycles="2">
<Repeat num_cycles="5">
<Sequence>
<MovePointSimple x="1.1"
y="0"
theta="0"
max_speed="0.10000"
max_speed="0.30000"
backwards="false"
action_name=""/>
<Sleep msec="1000"/>
<RotateSimple angle="180"
max_speed="0.300000"
max_speed="1.300000"
min_angle="10"
action_name=""/>
<Sleep msec="500"/>
<MovePointSimple x="0.35"
y="0"
theta="180"
max_speed="0.100000"
max_speed="0.300000"
backwards="false"
action_name=""/>
<RotateSimple angle="0"
max_speed="0.300000"
max_speed="1.300000"
min_angle="-10"
action_name=""/>
<Sleep msec="500"/>
<MovePointSimple x="1.1"
y="0"
theta="0"
max_speed="0.10000"
max_speed="0.30000"
backwards="false"
action_name=""/>
<Sleep msec="500"/>
<RotateSimple angle="180"
max_speed="0.300000"
max_speed="1.300000"
min_angle="-10"
action_name=""/>
<Sleep msec="500"/>
<MovePointSimple x="0.35"
y="0"
theta="180"
max_speed="0.100000"
max_speed="0.300000"
backwards="false"
action_name=""/>
<RotateSimple angle="0"
max_speed="0.300000"
max_speed="1.300000"
min_angle="10"
action_name=""/>
</Sequence>
@@ -113,6 +115,7 @@
<BehaviorTree ID="wheel_size">
<Sequence>
<WaitPullPin />
<Sleep msec="1000"/>
<ZeroOdom service_name=""/>
<Sleep msec="1000"/>

10
toid_bt/behavior_trees/toid_behaviors.btproj
View File

@@ -59,11 +59,11 @@
<input_port name="service_name" type="std::string">Service name</input_port>
</Action>
<Condition ID="SetInitialPose">
<input_port name="y" type="double" default="0.000000">Y position in meters</input_port>
<input_port name="theta" type="double" default="0.000000">Heading in degrees</input_port>
<input_port name="frame_id" type="std::string" default="map">Reference frame</input_port>
<input_port name="x" type="double" default="0.000000">X position in meters</input_port>
<input_port name="topic_name" type="std::string" default="__default__placeholder__">Topic name</input_port>
<input_port name="y" default="0.000000" type="double">Y position in meters</input_port>
<input_port name="theta" default="0.000000" type="double">Heading in degrees</input_port>
<input_port name="frame_id" default="map" type="std::string">Reference frame</input_port>
<input_port name="x" default="0.000000" type="double">X position in meters</input_port>
<input_port name="topic_name" default="__default__placeholder__" type="std::string">Topic name</input_port>
</Condition>
<Action ID="SetParameter">
<input_port name="parameter" type="std::string"/>

3
toid_navigation/params/toid_general_params.yaml
View File

@@ -29,12 +29,13 @@ behavior_server:
plugin: "nav2_behaviors::BackUp"
rotate:
plugin: "toid::SimpleRotateBehavior"
max_angular_accel: 4.0
max_angular_accel: 3.0
max_angular_decel: 1.0
translateX:
plugin: "toid::SimpleTranslateXBehavior"
moveCoords:
plugin: "toid::MoveCoords"
max_vel_accel: 1.0
approachAcorns:
plugin: "toid::ApproachAcorns"
kphi: 1.2