Finished first firmware draft...