Added MagicBox, FancyJoystick, and MathUtils classes. Added basic functionality to RobotMain