Add math stuff.
Increase system tick frequency.
Fix stuff.
Implement PID velocity control.
Some work on the readme.
Merge branch 'master' into rail