ROBOTC code for First FTC competition