Working version.

Everything but temperature sensor working.