lisyarus/psemek
1
0
Fork 1
Code Issues Pull requests 1 Projects Releases Packages Wiki Activity Actions

Add geom::rotate_towards

Browse source
This commit is contained in:
Nikita Lisitsa 2021-07-23 23:28:16 +03:00
parent a95182dc60
commit a944f8c4f4
1 changed files with 12 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

12
libs/geom/include/psemek/geom/math.hpp
View file

@ -110,6 +110,7 @@ namespace psemek::geom
return std::pair{x1, x2}; return std::pair{x1, x2};
} }
// returns (a1 - a0)
template <typename T> template <typename T>
T angle_difference(T a0, T a1) T angle_difference(T a0, T a1)
{ {
@ -124,6 +125,17 @@ namespace psemek::geom
return std::atan2(y, x); return std::atan2(y, x);
} }
template <typename T>
T rotate_towards(T value, T target, T max_difference)
{
auto d = angle_difference(value, target);
if (d > max_difference)
d = max_difference;
if (d < -max_difference)
d = -max_difference;
return value + d;
}
template <typename T> template <typename T>
T idiv(T x, T m) T idiv(T x, T m)
{ {