More Sensor cleanup

Compass and Pressure sensor now working, using RTOS
Pressure sensor returning bad data, need to troubleshoot.

Signed-off-by: Byron Marohn <combustible@live.com>