Cleaned up control code for SHT71

Final testing as well as low-power functionality still to be done