Feature/robot speed

Revision :)