grunner: Implemented speed scale parameter

Signed-off-by: David Jander <djander@gmail.com>
move: removed some obsolete debug code

Signed-off-by: David Jander <djander@gmail.com>
Added PID controller module

Signed-off-by: David Jander <djander@gmail.com>