Finished basic implementation.

*Need to straighten out DI
*Add temperature measuring