Merge pull request #20 from 31415us/master

feature : kalman simulation
limit frame rate
constants for the important stuff
add gaussian error to the measurement position
Merge pull request #21 from froj/master

looks reasonable (=