C-implementation for MPRTP header injection