Fixed some documentation
Built initial documetation using rosdoc_lite