final FloatBuffer source = BufferUtils.createFloatBufferOnHeap(16);
for (int i = sd.offset; i < floatData.length; i += sd.stride) {
source.rewind();
source.put(floatData, i, 16);
source.flip();
final Matrix4 mat = new Matrix4().fromFloatBuffer(source);
bindMatrices.add(new Transform().fromHomogeneousMatrix(mat));
}
}
}
// Use the skeleton information from the instance_controller to set the parent array locations on the
// joints.
Skeleton ourSkeleton = null; // TODO: maybe not the best way. iterate
final int[] order = new int[jointNames.size()];
for (int i = 0; i < jointNames.size(); i++) {
final String name = jointNames.get(i);
final ParamType paramType = paramTypes.get(i);
final String searcher = paramType == ParamType.idref_param ? "id" : "sid";
Element found = null;
for (final Element root : skeletonRoots) {
if (name.equals(root.getAttributeValue(searcher))) {
found = root;
} else if (paramType == ParamType.idref_param) {
found = _colladaDOMUtil.findTargetWithId(name);
} else {
found = (Element) _colladaDOMUtil.selectSingleNode(root, ".//*[@sid='" + name + "']");
}
// Last resorts (bad exporters)
if (found == null) {
found = _colladaDOMUtil.findTargetWithId(name);
}
if (found == null) {
found = (Element) _colladaDOMUtil.selectSingleNode(root, ".//*[@name='" + name + "']");
}
if (found != null) {
break;
}
}
if (found == null) {
if (paramType == ParamType.idref_param) {
found = _colladaDOMUtil.findTargetWithId(name);
} else {
found = (Element) _colladaDOMUtil.selectSingleNode(geometry, "/*//visual_scene//*[@sid='"
+ name + "']");
}
// Last resorts (bad exporters)
if (found == null) {
found = _colladaDOMUtil.findTargetWithId(name);
}
if (found == null) {
found = (Element) _colladaDOMUtil.selectSingleNode(geometry, "/*//visual_scene//*[@name='"
+ name + "']");
}
if (found == null) {
throw new ColladaException("Unable to find joint with " + searcher + ": " + name, skin);
}
}
final Joint joint = _dataCache.getElementJointMapping().get(found);
if (joint == null) {
logger.warning("unable to parse joint for: " + found.getName() + " " + name);
return;
}
joint.setInverseBindPose(bindMatrices.get(i));
ourSkeleton = _dataCache.getJointSkeletonMapping().get(joint);
order[i] = joint.getIndex();
}
// Make our skeleton pose
SkeletonPose skPose = _dataCache.getSkeletonPoseMapping().get(ourSkeleton);
if (skPose == null) {
skPose = new SkeletonPose(ourSkeleton);
_dataCache.getSkeletonPoseMapping().put(ourSkeleton, skPose);
// attach any attachment points found for the skeleton's joints
addAttachments(skPose);
// Skeleton's default to bind position, so update the global transforms.
skPose.updateTransforms();
}
// Read in our vertex_weights node
final Element weightsEL = skin.getChild("vertex_weights");
if (weightsEL == null) {
throw new ColladaException("skin found without vertex_weights.", skin);
}
// Pull out our per vertex joint indices and weights
final List<Short> jointIndices = Lists.newArrayList();
final List<Float> jointWeights = Lists.newArrayList();
int indOff = 0, weightOff = 0;
int maxOffset = 0;
for (final Element inputEL : weightsEL.getChildren("input")) {
final ColladaInputPipe pipe = new ColladaInputPipe(_colladaDOMUtil, inputEL);
final ColladaInputPipe.SourceData sd = pipe.getSourceData();
if (pipe.getOffset() > maxOffset) {
maxOffset = pipe.getOffset();
}
if (pipe.getType() == ColladaInputPipe.Type.JOINT) {
indOff = pipe.getOffset();
final String[] namesData = sd.stringArray;
for (int i = sd.offset; i < namesData.length; i += sd.stride) {
// XXX: the Collada spec says this could be -1?
final String name = namesData[i];
final int index = jointNames.indexOf(name);
if (index >= 0) {
jointIndices.add((short) index);
} else {
throw new ColladaException("Unknown joint accessed: " + name, inputEL);
}
}
} else if (pipe.getType() == ColladaInputPipe.Type.WEIGHT) {
weightOff = pipe.getOffset();
final float[] floatData = sd.floatArray;
for (int i = sd.offset; i < floatData.length; i += sd.stride) {
jointWeights.add(floatData[i]);
}
}
}
// Pull our values array
int firstIndex = 0, count = 0;
final int[] vals = _colladaDOMUtil.parseIntArray(weightsEL.getChild("v"));
try {
count = weightsEL.getAttribute("count").getIntValue();
} catch (final DataConversionException e) {
throw new ColladaException("Unable to parse count attribute.", weightsEL);
}
// use the vals to fill our vert weight map
final int[][] vertWeightMap = new int[count][];
int index = 0;
for (final int length : _colladaDOMUtil.parseIntArray(weightsEL.getChild("vcount"))) {
final int[] entry = new int[(maxOffset + 1) * length];
vertWeightMap[index++] = entry;
System.arraycopy(vals, (maxOffset + 1) * firstIndex, entry, 0, entry.length);
firstIndex += length;
}
// Create a record for the global ColladaStorage.
final String storeName = getSkinStoreName(instanceController, controller);
final SkinData skinDataStore = new SkinData(storeName);
// add pose to store
skinDataStore.setPose(skPose);
// Create a base Node for our skin meshes
final Node skinNode = new Node(meshNode.getName());
// copy Node render states across.
copyRenderStates(meshNode, skinNode);
// add node to store
skinDataStore.setSkinBaseNode(skinNode);
// Grab the bind_shape_matrix from skin
final Element bindShapeMatrixEL = skin.getChild("bind_shape_matrix");
final Transform bindShapeMatrix = new Transform();
if (bindShapeMatrixEL != null) {
final double[] array = _colladaDOMUtil.parseDoubleArray(bindShapeMatrixEL);
bindShapeMatrix.fromHomogeneousMatrix(new Matrix4().fromArray(array));
}
// Visit our Node and pull out any Mesh children. Turn them into SkinnedMeshes
for (final Spatial spat : meshNode.getChildren()) {
if (spat instanceof Mesh && ((Mesh) spat).getMeshData().getVertexCount() > 0) {