Update text README.md and package.xml

[rethink-forrest]

Before releasing this code to the broader robotics community, we need to include a more complete description of the SNS algorithm and code layout in the README.md and package.xml flies.