Make the code cleaner and simpler.

[delipl]

1. Try to make smaller functions whose names describe the functionality for example: turn_off_all(), play_disco().
2. Make the header file with declarations of these functions in .hpp and definitions in .cpp file.