Initial check-in - cleaned and modified for TurtleBot