Implemented the Robot Following Ability and Keyboard Command

Signed-off-by: Andoni Aguirrezabal <aaguirrezabal@live.com>