Revert changes to writeFlashPage()

Revert changes to writeFlashPage() - the changes introduced some
inconsistency and only saved 4 bytes anyways. This version is verified
and works.