Create Main_Program.c

This is the main software program of the embedded servo controller demonstration.