Changed code to work for our robot instead of kobuki
Merge pull request #1 from valeRB/master

Changed code to work for our robot instead of kobuki