Navigating is getting better all the time here we are using ROS smach to go via 2 way points and arrive at a 3rd point. Later we will add arm movement so we can get a object

http://escaliente-robotics.blogspot.com.au/