Got multi protocol to work over udp.
Formatted code with astyle.