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 | |
| parent | BulletSim: add the editting children in linkset going phantom bug to TODO list. (diff) | |
| download | opensim-SC_OLD-caad1edabf755c2ef8e00f94f39a8b4c524012b4.zip opensim-SC_OLD-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.gz opensim-SC_OLD-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.bz2 opensim-SC_OLD-caad1edabf755c2ef8e00f94f39a8b4c524012b4.tar.xz | |
Add utility function to clamp a vector to a maximum magnitude.
| -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> |