wt_node odom: Also set z velocity to 0

[ros_wild_thumper.git] / scripts / engine_man_test.py

diff --git a/scripts/engine_man_test.py b/scripts/engine_man_test.py
index ae639ae74af2a555e34471d1962eea11dd9562c3..a62a50d4375d4fa70450fb58bd21f7681306efb8 100755 (executable)
--- a/scripts/engine_man_test.py
+++ b/scripts/engine_man_test.py
@@ -14,6 +14,7 @@ def set_pwm(left, right):
        i2c_write_reg(0x50, 0x7, struct.pack(">h", right))
 
 if __name__ == "__main__":
+       i2c_write_reg(0x50, 0x90, struct.pack("BBBB", 1, 1, 0, 0)) # switch direction
        set_pwm(int(sys.argv[1]), int(sys.argv[2]))
 
        while True: