Added motion magic stuff

Looked at the CTRE website and went to github. Added the stuff we saw on there for motion magic. Needs to be tested to see if it's accurate.

src/main/java/frc4388/robot/RobotContainer.java

@@ -69,6 +69,9 @@ public class RobotContainer {
         new JoystickButton(getOperatorJoystick(), XboxController.A_BUTTON)
             .whenPressed(() -> m_robotLED.setPattern(LEDPatterns.LAVA_RAINBOW))
             .whenReleased(() -> m_robotLED.setPattern(LEDConstants.DEFAULT_PATTERN));
+
+        new JoystickButton(getDriverJoystick(), XboxController.B_BUTTON)
+            .whenPressed(() -> m_robotDrive.goToTargetPos());
     }
     
     /**