Add src file and makefile

Signed-off-by: Loic Poulain <loicx.poulain@intel.com>