Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- Option Explicit
- Public Function wrapTo180(Ang) As Double
- ' fit angle (in degrees) into range (-180; 180]
- Dim AngleTo As Double
- AngleTo = Ang
- If AngleTo > 180 Then
- While (AngleTo > 180)
- AngleTo = AngleTo - 360
- Wend
- End If
- If AngleTo <= -180 Then
- While (AngleTo <= -180)
- AngleTo = AngleTo + 360
- Wend
- End If
- wrapTo180 = AngleTo
- End Function
- Public Function wrapToPi(Ang) As Double
- ' fit angle (in radians) into range (-pi; pi]
- Dim AngleTo As Double
- AngleTo = Ang
- If AngleTo > Pi Then
- While (AngleTo > Pi)
- AngleTo = AngleTo - 2 * Pi
- Wend
- End If
- If AngleTo <= -Pi Then
- While (AngleTo <= -Pi)
- AngleTo = AngleTo + 2 * Pi
- Wend
- End If
- wrapToPi = AngleTo
- End Function
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement