Робот на платформе Mindstorms NXT, программа на Robot-C