Updated readme, todo, and some comments in .ino