/* 
 | 
 * 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; 
 | 
    } 
 | 
     
 | 
} 
 |