Hi Amit,
Its not really that hard. Give it a try at least. It is only C code not C++. Wrong code is not likely to damage the board. Post the merged file and we can check it for you.
You might read:
KFLOP C Programs - Dynomotion
Actually the forever loop in your Init program is for enabling/disabling KStep. I don't believe you are using KStep. So that isn't even needed. All you really need to do is to be able to find the loop and replace it. Also add the called functions.
If you don't have time or can't configure/program your machine yourself we can connect in and help you do this. But for this we charge a fee.
Regards