diff options
author | Robert Adams | 2013-01-17 14:44:54 -0800 |
---|---|---|
committer | Robert Adams | 2013-01-17 14:44:54 -0800 |
commit | caad1edabf755c2ef8e00f94f39a8b4c524012b4 (patch) | |
tree | 06085b5c7d147129398354d44303a8d746cb6fdb /OpenSim | |
parent | BulletSim: add the editting children in linkset going phantom bug to TODO list. (diff) | |
download | opensim-SC-caad1edabf755c2ef8e00f94f39a8b4c524012b4.zip opensim-SC-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.gz opensim-SC-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.bz2 opensim-SC-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.xz |
Add utility function to clamp a vector to a maximum magnitude.
Diffstat (limited to 'OpenSim')
-rw-r--r-- | OpenSim/Framework/Util.cs | 12 |
1 files changed, 12 insertions, 0 deletions
diff --git a/OpenSim/Framework/Util.cs b/OpenSim/Framework/Util.cs index f511494..f6c9d15 100644 --- a/OpenSim/Framework/Util.cs +++ b/OpenSim/Framework/Util.cs | |||
@@ -299,6 +299,18 @@ namespace OpenSim.Framework | |||
299 | x; | 299 | x; |
300 | } | 300 | } |
301 | 301 | ||
302 | // Clamp the maximum magnitude of a vector | ||
303 | public static Vector3 ClampV(Vector3 x, float max) | ||
304 | { | ||
305 | Vector3 ret = x; | ||
306 | float lenSq = x.LengthSquared(); | ||
307 | if (lenSq > (max * max)) | ||
308 | { | ||
309 | x = x / x.Length() * max; | ||
310 | } | ||
311 | return x; | ||
312 | } | ||
313 | |||
302 | // Inclusive, within range test (true if equal to the endpoints) | 314 | // Inclusive, within range test (true if equal to the endpoints) |
303 | public static bool InRange<T>(T x, T min, T max) | 315 | public static bool InRange<T>(T x, T min, T max) |
304 | where T : IComparable<T> | 316 | where T : IComparable<T> |