Fixed a small math error in structs.h. Modified the sensor code for testing.