X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=scripts%2Fdwm1000.py;h=b16ff9ecb30faca5ef2727d391bb15e7866da337;hp=b237516cca74da2d13af71d9f7f03ddaa073887b;hb=2f194b3fe82009a77b79021f0c57e6ca55c1706f;hpb=4567660199e3bbee6be162cc169df125b60e4fd8 diff --git a/scripts/dwm1000.py b/scripts/dwm1000.py index b237516..b16ff9e 100755 --- a/scripts/dwm1000.py +++ b/scripts/dwm1000.py @@ -1,7 +1,7 @@ #!/usr/bin/env python # -*- coding: iso-8859-15 -*- -VISULAIZE = False +VISUALIZE = False import threading import struct @@ -16,7 +16,7 @@ from std_msgs.msg import Float32 from nav_msgs.msg import Odometry from wild_thumper.srv import DWM1000Center, DWM1000CenterResponse from pyshared.simple_kalman import simple_kalman -if VISULAIZE: +if VISUALIZE: import matplotlib.pyplot as plt @@ -147,7 +147,7 @@ if __name__ == "__main__": diff = abs(dist_left - dist_right) if diff >= dist_l_r: - # difference to high, correct to maximum + # difference too high, correct to maximum off = diff - dist_l_r + 0.01 if dist_left > dist_right: dist_left -= off/2 @@ -168,7 +168,7 @@ if __name__ == "__main__": x, y = pos.filter(x, y) - if VISULAIZE: + if VISUALIZE: circle_left = plt.Circle((-dist_l_r/2, 0), dwleft.distance, color='red', fill=False) circle_right = plt.Circle((dist_l_r/2, 0), dwright.distance, color='green', fill=False) plt.gca().add_patch(circle_left)