A lot of modifications to fit code refactoring in aversive++.
Not tested at all, but compiles.
Merge branch 'master' of https://github.com/astralien3000/robot2014