FIRST Team 422's FIRST Robotics Challenge Robot Code for 2014