Changed code to work for our robot instead of kobuki