Add an overload of resetHeadingData() which takes in a Rotation3d (#2013)

Author: kcooney

photon-lib/src/main/java/org/photonvision/PhotonPoseEstimator.java

@@ -316,7 +316,7 @@ public void setLastPose(Pose2d lastPose) {
      * Add robot heading data to buffer. Must be called periodically for the
      * <b>PNP_DISTANCE_TRIG_SOLVE</b> strategy.
      *
-     * @param timestampSeconds timestamp of the robot heading data.
+     * @param timestampSeconds Timestamp of the robot heading data.
      * @param heading Field-relative robot heading at given timestamp. Standard WPILIB field
      *     coordinates.
      */
@@ -328,7 +328,7 @@ public void addHeadingData(double timestampSeconds, Rotation3d heading) {
      * Add robot heading data to buffer. Must be called periodically for the
      * <b>PNP_DISTANCE_TRIG_SOLVE</b> strategy.
      *
-     * @param timestampSeconds timestamp of the robot heading data.
+     * @param timestampSeconds Timestamp of the robot heading data.
      * @param heading Field-relative robot heading at given timestamp. Standard WPILIB field
      *     coordinates.
      */
@@ -340,7 +340,20 @@ public void addHeadingData(double timestampSeconds, Rotation2d heading) {
      * Clears all heading data in the buffer, and adds a new seed. Useful for preventing estimates
      * from utilizing heading data provided prior to a pose or rotation reset.
      *
-     * @param timestampSeconds timestamp of the robot heading data.
+     * @param timestampSeconds Timestamp of the robot heading data.
+     * @param heading Field-relative robot heading at given timestamp. Standard WPILIB field
+     *     coordinates.
+     */
+    public void resetHeadingData(double timestampSeconds, Rotation3d heading) {
+        headingBuffer.clear();
+        addHeadingData(timestampSeconds, heading);
+    }
+
+    /**
+     * Clears all heading data in the buffer, and adds a new seed. Useful for preventing estimates
+     * from utilizing heading data provided prior to a pose or rotation reset.
+     *
+     * @param timestampSeconds Timestamp of the robot heading data.
      * @param heading Field-relative robot heading at given timestamp. Standard WPILIB field
      *     coordinates.
      */