Fix in C implementation of the protocol

Signed-off-by: Mika Tammi <mika.tammi@intel.com>