Correction of bug + tested out functions
Removed function calls for test
Placed function calls in sensor function