com.github.dabasan.jxm.pd1.PD1Writer Maven / Gradle / Ivy

Go to download

Show more of this group Show more artifacts with this name
Show all versions of jxm-pd1 Show documentation

There is a newer version: 2.2.0

package com.github.dabasan.jxm.pd1;

import java.io.BufferedOutputStream;
import java.io.IOException;
import java.io.OutputStream;
import java.util.ArrayList;
import java.util.List;

import com.github.dabasan.ejml_3dtools.Vector;
import com.github.dabasan.jxm.bintools.ByteFunctions;

/**
 * PD1 writer
 * 
 * @author Daba
 *
 */
class PD1Writer {
	public PD1Writer() {

	}

	public void write(OutputStream os, List points) throws IOException {
		List bin = new ArrayList<>();

		// Number of points
		int numPoints = points.size();
		ByteFunctions.addUnsignedShortValueToBinLE(bin, numPoints);

		// Point data
		for (int i = 0; i < numPoints; i++) {
			PD1Point point = points.get(i);

			// Position
			Vector position = point.getPosition();

			ByteFunctions.addFloatValueToBinLE(bin, position.getXFloat());
			ByteFunctions.addFloatValueToBinLE(bin, position.getYFloat());
			ByteFunctions.addFloatValueToBinLE(bin, position.getZFloat());

			// Rotation
			double rotation = point.getRotation();

			ByteFunctions.addFloatValueToBinLE(bin, (float) rotation);

			// Parameters
			int[] parameters = point.getParameters();

			for (int j = 0; j < 4; j++) {
				bin.add((byte) parameters[j]);
			}
		}

		try (var bos = new BufferedOutputStream(os)) {
			for (Byte b : bin) {
				bos.write(b);
			}
		}
	}
}