trig_util.cpp
Go to the documentation of this file.
1 // *****************************************************************************
2 //
3 // Copyright (c) 2014, Southwest Research Institute® (SwRI®)
4 // All rights reserved.
5 //
6 // Redistribution and use in source and binary forms, with or without
7 // modification, are permitted provided that the following conditions are met:
8 // * Redistributions of source code must retain the above copyright
9 // notice, this list of conditions and the following disclaimer.
10 // * Redistributions in binary form must reproduce the above copyright
11 // notice, this list of conditions and the following disclaimer in the
12 // documentation and/or other materials provided with the distribution.
13 // * Neither the name of Southwest Research Institute® (SwRI®) nor the
14 // names of its contributors may be used to endorse or promote products
15 // derived from this software without specific prior written permission.
16 //
17 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18 // AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 // ARE DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDER> BE LIABLE FOR ANY
21 // DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
22 // (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
23 // LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
24 // ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
26 // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 //
28 // *****************************************************************************
29 
31 
33 
34 namespace swri_math_util
35 {
36  double WrapRadians(double angle, double center)
37  {
38  double wrapped = angle;
39  while (wrapped < center && center - wrapped > _pi)
40  {
41  wrapped += _2pi;
42  }
43 
44  while (wrapped > center && wrapped - center > _pi)
45  {
46  wrapped -= _2pi;
47  }
48 
49  return wrapped;
50  }
51 
52  double ToRadians(double degrees)
53  {
54  return degrees * _pi / 180.0;
55  }
56 
57  double ToDegrees(double radians)
58  {
59  return radians * 180.0 / _pi;
60  }
61 }
double WrapRadians(double angle, double center)
Definition: trig_util.cpp:36
static const long double _2pi
Definition: constants.h:37
static const long double _pi
Definition: constants.h:35
double ToRadians(double degrees)
Definition: trig_util.cpp:52
double ToDegrees(double radians)
Definition: trig_util.cpp:57


swri_math_util
Author(s): Marc Alban
autogenerated on Sat Jan 21 2023 03:13:11