Loc Changes

Fix assertion failure in the master, fix odometry in loc, partially fix odometry in balltrack (josh imhoff has my second commit), change particle scoring