MDBET Week 2

Code ran at the Week 2 District Competition hosted by Walt Whitman High School. Currently have support for a variety of autonomous routines, and have a functional double jointed arm trajectory planning and following with an accurate predictive (feedforward) and closed loop PID control. Since the scrimmage, we added support for a ground intake for faster cycle times when intaking game pieces from the floor.