telnetserver.h and telnetserver.c added (modified sample from ST)