Main function in robotC