Create controlnewalg.c

I don't understand this.
PS I'm going to bed now. Will work on robot more tomorrow.