Merge pull request #1 from galassia/telecommands

Telecommands
Compilable version
TEC ON implemented