Update robotc code 2014-2015 test of movment