encoder data slow

[jurriaanvoskes]

the motor encoder data is updated at a very slow rate, which has as result that the currentpose of the robot is also updated very slow.

[windelbouwman]

This has been fixed but must be properly tested on the floor.