Write Functions

Write functions tested, need to implement all read functions for sensor
data