Initial commit to have a base point to start from.

To have a good base to start from. Based off the 2012_basket_ball_robot code with a few improvements.