step ?>=? count

Normand Briere

2016-02-27 28ab4dad99d24372ea58b09a00eafbce1291c278

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
/*
 * Java port of Bullet (c) 2008 Martin Dvorak <jezek2@advel.cz>
 *
 * This source file is part of GIMPACT Library.
 *
 * For the latest info, see http://gimpact.sourceforge.net/
 *
 * Copyright (c) 2007 Francisco Leon Najera. C.C. 80087371.
 * email: projectileman@yahoo.com
 *
 * This software is provided 'as-is', without any express or implied warranty.
 * In no event will the authors be held liable for any damages arising from
 * the use of this software.
 * 
 * Permission is granted to anyone to use this software for any purpose, 
 * including commercial applications, and to alter it and redistribute it
 * freely, subject to the following restrictions:
 * 
 * 1. The origin of this software must not be misrepresented; you must not
 *    claim that you wrote the original software. If you use this software
 *    in a product, an acknowledgment in the product documentation would be
 *    appreciated but is not required.
 * 2. Altered source versions must be plainly marked as such, and must not be
 *    misrepresented as being the original software.
 * 3. This notice may not be removed or altered from any source distribution.
 */
 
package com.bulletphysics.extras.gimpact;
 
import com.bulletphysics.linearmath.VectorUtil;
import cz.advel.stack.Stack;
import javax.vecmath.Vector3f;
 
/**
 *
 * @author jezek2
 */
class Quantization {
 
    public static void bt_calc_quantization_parameters(Vector3f outMinBound, Vector3f outMaxBound, Vector3f bvhQuantization, Vector3f srcMinBound, Vector3f srcMaxBound, float quantizationMargin) {
        // enlarge the AABB to avoid division by zero when initializing the quantization values
        Vector3f clampValue = Stack.alloc(Vector3f.class);
        clampValue.set(quantizationMargin, quantizationMargin, quantizationMargin);
        outMinBound.sub(srcMinBound, clampValue);
        outMaxBound.add(srcMaxBound, clampValue);
        Vector3f aabbSize = Stack.alloc(Vector3f.class);
        aabbSize.sub(outMaxBound, outMinBound);
        bvhQuantization.set(65535.0f, 65535.0f, 65535.0f);
        VectorUtil.div(bvhQuantization, bvhQuantization, aabbSize);
    }
 
    public static void bt_quantize_clamp(short[] out, Vector3f point, Vector3f min_bound, Vector3f max_bound, Vector3f bvhQuantization) {
        Vector3f clampedPoint = (Vector3f) Stack.alloc(point);
        VectorUtil.setMax(clampedPoint, min_bound);
        VectorUtil.setMin(clampedPoint, max_bound);
 
        Vector3f v = Stack.alloc(Vector3f.class);
        v.sub(clampedPoint, min_bound);
        VectorUtil.mul(v, v, bvhQuantization);
 
        out[0] = (short) (v.x + 0.5f);
        out[1] = (short) (v.y + 0.5f);
        out[2] = (short) (v.z + 0.5f);
    }
 
    public static Vector3f bt_unquantize(short[] vecIn, Vector3f offset, Vector3f bvhQuantization, Vector3f out) {
        out.set((float)(vecIn[0] & 0xFFFF) / (bvhQuantization.x),
                (float)(vecIn[1] & 0xFFFF) / (bvhQuantization.y),
                (float)(vecIn[2] & 0xFFFF) / (bvhQuantization.z));
        out.add(offset);
        return out;
    }
    
}