inverse value for pitch_handicap_strength

[ros_wild_thumper.git] / scripts / wt_node.py

diff --git a/scripts/wt_node.py b/scripts/wt_node.py
index 5fc59d7dbf5dad1dfd63639fa267534032073aa4..781acfa593abd636ffb8d9d339026462c62da9d1 100755 (executable)
--- a/scripts/wt_node.py
+++ b/scripts/wt_node.py
@@ -106,7 +106,7 @@ class MoveBase:
                self.odom_covar_angle = config["odom_covar_angle"]
                self.pitch_handicap_enable = config["pitch_handicap_enable"]
                self.pitch_handicap_limit = config["pitch_handicap_limit"]
                self.odom_covar_angle = config["odom_covar_angle"]
                self.pitch_handicap_enable = config["pitch_handicap_enable"]
                self.pitch_handicap_limit = config["pitch_handicap_limit"]

-               self.pitch_handicap_strength = config["pitch_handicap_strength"]
+               self.pitch_handicap_strength = 100-config["pitch_handicap_strength"]

 
                if not self.pitch_handicap_enable:
                        self.set_motor_handicap(0, 0)
 
                if not self.pitch_handicap_enable:
                        self.set_motor_handicap(0, 0)