General:
- Cleaned up files
- Moved LED to LED.cpp
- Move timer_handler to timer module

Sensor+Controller:
- Added logic for reliability, needs testing and improvement