Formatted code, removed redundant comments and debug info;
Bugfix: now outputting all sensor value