feat(geometry): adding arcAngle function in Geometry::Arc

MaracatronicsRobotics · Jan 26, 2024 · 1df9265 · 1df9265
1 parent 4116161
commit 1df9265
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 0 deletions.
diff --git a/include/Armorial/Geometry/Arc/Arc.h b/include/Armorial/Geometry/Arc/Arc.h
@@ -76,6 +76,11 @@ namespace Geometry {
          */
         [[nodiscard]] bool pointInArc(const Vector2D &point) const;
 
+        /*!
+         * \return The absolute angle of an arc.
+         */
+        [[nodiscard]] float arcAngle() const;
+
         /*!
          * \brief Compute the points at which a given LineSegment intersects this Arc instance, if these points exists.
          * \param lineSegment The given LineSegment instance.

diff --git a/src/Armorial/Geometry/Arc/Arc.cpp b/src/Armorial/Geometry/Arc/Arc.cpp
@@ -75,6 +75,11 @@ bool Arc::pointInArc(const Vector2D &point) const {
     return (angleWithinArc(normPoint.angle()) && (normPoint.length() <= radius()));
 }
 
+float Arc::arcAngle() const{
+    float startAngle = (_startAngle.value() < 0) ? _startAngle.value() + M_PI*2 : _startAngle.value();
+    float endAngle = (_endAngle.value() < 0) ? _endAngle.value() + M_PI*2 : _endAngle.value();
+    return std::abs(startAngle - endAngle);
+}
 std::vector<Vector2D> Arc::intersectionWithLine(const LineSegment &lineSegment) const {
     std::vector<Vector2D> intersections;