Added current firmware code. Initial commit.