First Commit
Motor model seems to work; particle filter works for robot, not yet for ball
Added cpp files
Merge branch 'master' of https://github.com/jmabartlett/RobotSoccer