Update firmware, readme

Updated firmware, readme.