/**
 * Usunie z danej w parametrze wiadomości sekwencje sterujące protokołu telnet.
 */
void delete_control_sequences(unsigned char *message) {

    unsigned char tmp_buffer[MAX_COMMAND_SIZE];

    int i, j;

    memset(&tmp_buffer, 0, MAX_COMMAND_SIZE);

    while (i < MAX_COMMAND_SIZE + 2) {

        if (message[i] == 0xff) {

            // Sekwencja [255][255] -> 255
            if (message[i + 1] == 0xff) {
                tmp_buffer[j] = tmp_buffer[i];
                i += 2;
            }
            else
            // Sekwencja [255][251 - 254][coś] -> null
            if (message[i + 1] >= 0xfb) {
                i += 3;
            }
            // Sekwencja [255][coś] -> null
            else {
                i += 2;
            }
        }
        else {
            tmp_buffer[j] = message[i];
            ++i;
        }

        ++j;
    }
}