Reorganized sections. Included hall effect zeroing, untested.