Decreasing cyclomatic complexity of pico_tcp.c (part 2)