Доработка кода SOCKS5 сервера на Си

Имеется код, запускающий процесс сокс5 сервера на заранее заданном порту.

Задача:

Доработать код таким образом, чтобы при приёме пакета определённого вида на прослушиваемый порт последний менялся на заданный в принятом пакете.

Другими словами:

Имеется сервер, на котором запущен процесс сокса (допустим на 1234 порту). При приёме заранее заданного пакета (содержащего в себе директиву изменения порта на 2345) на порт 1234 процесс меняет прослушиваемый порт на 2345.