Skip to content

Commit

Permalink
fix bit
Browse files Browse the repository at this point in the history
  • Loading branch information
tamago117 committed Oct 24, 2024
1 parent e4a3be2 commit 71f9c50
Show file tree
Hide file tree
Showing 3 changed files with 35 additions and 33 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -7,8 +7,10 @@
<group>
<push-ros-namespace namespace="control" />

<let name="steering_tire_angle_gain_var" value="1.0" if="$(var simulation)" />
<let name="steering_tire_angle_gain_var" value="1.639" unless="$(var simulation)" />

<let name="steering_tire_angle_gain_var" value="1.1" if="$(var simulation)" />
<!-- <let name="steering_tire_angle_gain_var" value="1.0" if="$(var simulation)" /> -->
<!-- <let name="steering_tire_angle_gain_var" value="1.639" unless="$(var simulation)" /> -->

<node pkg="simple_pure_pursuit" exec="simple_pure_pursuit" name="simple_pure_pursuit_node"
output="screen" unless="$(var use_stanley)">
Expand All @@ -18,8 +20,8 @@
<param name="lookahead_min_distance" value="4.0" />
<param name="speed_proportional_gain" value="3.0" />
<param name="steering_tire_angle_gain" value="$(var steering_tire_angle_gain_var)"/>
<param name="curve_param_max_steer_angle" value="0.15" />
<param name="curve_param_deceleration_vel" value="4.0" />
<param name="curve_param_max_steer_angle" value="0.25" />
<param name="curve_param_deceleration_vel" value="3.0" />
<remap from="input/kinematics" to="/localization/kinematic_state" />
<!-- global path or mppi-->
<remap from="input/trajectory" to="/planning/output/mppi_planned_path" />
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -319,32 +319,32 @@
316.9554219, 89672.6884026, 43148.6722231, 1.9369643, -0.0630982, 8.3000002, -0.0000003
317.9552813, 89671.7274590, 43148.3404117, 1.8681720, -0.0713722, 8.3000002, -0.0000003
318.9551407, 89670.7891955, 43148.0886394, 1.7975236, -0.0727092, 8.3000002, 0.0000001
319.9550001, 89669.8492647, 43147.9059624, 1.7279369, -0.0718879, 8.3000002, 0.0000002
320.9548594, 89668.8677931, 43147.7844303, 1.6621362, -0.0594515, 8.3000002, -0.0000018
321.9547188, 89667.8477743, 43147.7189888, 1.6115983, -0.0323566, 8.3000000, -0.0000075
322.9545782, 89666.8870461, 43147.6878232, 1.6012438, 0.0078553, 8.2999991, -0.0000075
323.9544376, 89665.8702204, 43147.6471983, 1.6253914, 0.0385325, 8.2999982, -0.4965420
324.9542969, 89664.8285192, 43147.5640542, 1.6800015, 0.0618168, 8.2399651, -2.7764627
325.9541563, 89663.8180387, 43147.4205799, 1.7442555, 0.0652220, 5.8958775, -2.6580497
326.9540157, 89662.8316136, 43147.2125712, 1.8148382, 0.0762882, 5.5517898, -2.5396368
327.9538751, 89661.9004967, 43146.9407488, 1.8983880, 0.0984561, 5.2077021, -1.2478391
328.9537344, 89660.9125367, 43146.5417532, 2.0146056, 0.1201909, 5.0324706, -1.1603200
329.9535938, 89660.0473698, 43146.0605634, 2.1467704, 0.1482842, 4.8655174, -0.8675554
330.9534532, 89659.2985548, 43145.4898060, 2.3031280, 0.1839607, 4.7379865, 0.0151902
331.9533126, 89658.6331506, 43144.7692404, 2.4886387, 0.1827575, 4.7402402, 0.0151953
332.9531719, 89658.0915381, 43143.9219930, 2.6476890, 0.1285749, 4.7424939, 2.6104415
333.9530313, 89657.6836940, 43143.0553096, 2.7500975, 0.0912958, 5.1190851, 3.2575383
334.9528907, 89657.3405269, 43142.1126528, 2.8319816, 0.0741205, 5.5627729, 3.3328650
335.9527501, 89657.0591878, 43141.1058887, 2.9049336, 0.0664698, 5.9912656, 0.8277498
336.9526094, 89656.8575800, 43140.1384001, 2.9658322, 0.0571485, 8.0941703, 0.8383407
337.9524688, 89656.7093917, 43139.1473195, 3.0192909, 0.0498528, 8.1970750, 0.8489315
338.9523282, 89656.6104514, 43138.1424047, 3.0666705, 0.0442394, 8.2999797, 0.0001660
339.9521876, 89656.5559492, 43137.1435252, 3.1057862, 0.0339869, 8.2999997, 0.0000020
340.9520469, 89656.5354507, 43136.1433162, 3.1347380, 0.0239193, 8.2999999, 0.0000020
341.9519063, 89656.5388818, 43135.1444283, -3.1295233, 0.0139746, 8.3000002, -0.0000002
342.9517657, 89656.5556990, 43134.1362332, -3.1229445, -0.0014044, 8.3000001, -0.0000004
343.9516251, 89656.5709672, 43133.1343800, -3.1325104, -0.0178663, 8.3000001, -0.0000004
344.9514844, 89656.5683763, 43132.1434946, 3.1243702, -0.0354989, 8.3000001, -0.0000000
345.9513438, 89656.5303615, 43131.1236043, 3.0828151, -0.0451562, 8.3000001, 0.0000000
346.9512032, 89656.4470347, 43130.1235739, 3.0322801, -0.0560909, 8.3000001, -2.1244137
319.9550001, 89669.8492647, 43147.9059624, 1.7279369, -0.0718879, 4.3000002, 0.0000002
320.9548594, 89668.8677931, 43147.7844303, 1.6621362, -0.0594515, 4.3000002, -0.0000018
321.9547188, 89667.8477743, 43147.7189888, 1.6115983, -0.0323566, 4.3000000, -0.0000075
322.9545782, 89666.8870461, 43147.6878232, 1.6012438, 0.0078553, 4.2999991, -0.0000075
323.9544376, 89665.8702204, 43147.6471983, 1.6253914, 0.0385325, 4.2999982, -0.4965420
324.9542969, 89664.8285192, 43147.5640542, 1.6800015, 0.0618168, 3.2399651, -2.7764627
325.9541563, 89663.8180387, 43147.4205799, 1.7442555, 0.0652220, 3.8958775, -2.6580497
326.9540157, 89662.8316136, 43147.2125712, 1.8148382, 0.0762882, 3.5517898, -2.5396368
327.9538751, 89661.9004967, 43146.9407488, 1.8983880, 0.0984561, 3.2077021, -1.2478391
328.9537344, 89660.9125367, 43146.5417532, 2.0146056, 0.1201909, 3.0324706, -1.1603200
329.9535938, 89660.0473698, 43146.0605634, 2.1467704, 0.1482842, 2.8655174, -0.8675554
330.9534532, 89659.2985548, 43145.4898060, 2.3031280, 0.1839607, 2.7379865, 0.0151902
331.9533126, 89658.6331506, 43144.7692404, 2.4886387, 0.1827575, 2.7402402, 0.0151953
332.9531719, 89658.0915381, 43143.9219930, 2.6476890, 0.1285749, 2.7424939, 2.6104415
333.9530313, 89657.6836940, 43143.0553096, 2.7500975, 0.0912958, 3.1190851, 3.2575383
334.9528907, 89657.3405269, 43142.1126528, 2.8319816, 0.0741205, 3.5627729, 3.3328650
335.9527501, 89657.0591878, 43141.1058887, 2.9049336, 0.0664698, 3.9912656, 0.8277498
336.9526094, 89656.8575800, 43140.1384001, 2.9658322, 0.0571485, 3.0941703, 0.8383407
337.9524688, 89656.7093917, 43139.1473195, 3.0192909, 0.0498528, 3.1970750, 0.8489315
338.9523282, 89656.6104514, 43138.1424047, 3.0666705, 0.0442394, 3.2999797, 0.0001660
339.9521876, 89656.5559492, 43137.1435252, 3.1057862, 0.0339869, 3.2999997, 0.0000020
340.9520469, 89656.5354507, 43136.1433162, 3.1347380, 0.0239193, 3.2999999, 0.0000020
341.9519063, 89656.5388818, 43135.1444283, -3.1295233, 0.0139746, 4.3000002, -0.0000002
342.9517657, 89656.5556990, 43134.1362332, -3.1229445, -0.0014044, 4.3000001, -0.0000004
343.9516251, 89656.5709672, 43133.1343800, -3.1325104, -0.0178663, 4.3000001, -0.0000004
344.9514844, 89656.5683763, 43132.1434946, 3.1243702, -0.0354989, 4.3000001, -0.0000000
345.9513438, 89656.5303615, 43131.1236043, 3.0828151, -0.0451562, 4.3000001, 0.0000000
346.9512032, 89656.4470347, 43130.1235739, 3.0322801, -0.0560909, 4.3000001, -2.1244137
347.9510626, 89656.3124028, 43129.1596191, 2.9710383, -0.0704782, 8.0400106, -0.8017657
Original file line number Diff line number Diff line change
Expand Up @@ -156,7 +156,7 @@ void SimplePurePursuit::onTimer()
pub_cmd_->publish(cmd);

// publish real-machine command
cmd.lateral.steering_tire_angle /= steering_tire_angle_gain_;
//cmd.lateral.steering_tire_angle /= steering_tire_angle_gain_;
pub_raw_cmd_->publish(cmd);
}

Expand Down

0 comments on commit 71f9c50

Please sign in to comment.