Roger Labbe 335df7f42d Fixed bug in EKF residual function.
Comment was wrong, it normalizes to [-pi, pi].

Also, code didn't handle cases where a-b > 2Pi
2015-07-15 19:03:59 -07:00
..
2015-06-22 17:56:14 -07:00
2015-06-30 20:14:39 -07:00
2015-07-13 14:42:34 -07:00
2015-04-20 17:14:51 -07:00
2015-07-13 14:42:34 -07:00
2015-07-13 14:42:34 -07:00