Add actual code and update README.md with usage info