Merge pull request #13 from mlosch/master

add skeleton for ir curve fitting
add encoder frequency
using constants from robot.h
fix issues
Merge pull request #14 from tobiasandersson/master

fix issues
Merge remote-tracking branch 'upstream/master'
add intial w, tuning parameters on robot, bugfixes