New Loc, better ball filter, split up tool

This pull request includes improved localization (with loc kicking), improvements to the ball filter, and the tool that has been split up into loc tool and vision tool.