Removed all dynamic allocation from telemetry loop (+some names
refactoring)
Improve debug messages
Improve debug messages
Disable telemetry for now
Improved debug messages
reorder tasks