#!/usr/bin/env python
# -*- coding: iso-8859-15 -*-
-VISULAIZE = False
+VISUALIZE = False
import threading
import struct
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
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
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)