Added angular and translational controller.

- RobotController stores past error to calculate
  a useful noise-insensitive derivative and integral
  of angular and translational error.
- Parameters still untuned.
- Lots of debug statements added.
- Data classes moved into robot.datautils package.
Merge branch 'master' of http://github.com/maslab-team/maslab-2014-team17