bundles/addons/org.eclipse.apogy.addons.sensors.pose.ui/src/org/eclipse/apogy/addons/sensors/pose/ui/composites/EditOrientationComposite.java

package org.eclipse.apogy.addons.sensors.pose.ui.composites;
/*******************************************************************************
 * Copyright (c) 2018 Agence spatiale canadienne / Canadian Space Agency
 * All rights reserved. This program and the accompanying materials
 * are made available under the terms of the Eclipse Public License v1.0
 * which accompanies this distribution, and is available at
 * http://www.eclipse.org/legal/epl-v10.html
 *
 * Contributors:
 *     Pierre Allard - initial API and implementation
 *     Regent L'Archeveque
 * 
 * SPDX-License-Identifier: EPL-1.0
 *******************************************************************************/

import org.eclipse.apogy.addons.sensors.pose.OrientationSensor;
import org.eclipse.apogy.common.geometry.data3d.ApogyCommonGeometryData3DFacade;
import org.eclipse.apogy.common.geometry.data3d.CartesianOrientationCoordinates;
import org.eclipse.swt.SWT;
import org.eclipse.swt.graphics.Point;
import org.eclipse.swt.layout.GridData;
import org.eclipse.swt.layout.GridLayout;
import org.eclipse.swt.widgets.Composite;
import org.eclipse.swt.widgets.Label;
import org.eclipse.swt.widgets.Text;

public class EditOrientationComposite extends Composite {
	private OrientationSensor orientationSensor;

	private Text xValueText = null;
	private Text yValueText = null;
	private Text zValueText = null;

	public EditOrientationComposite(Composite parent, int style) {
		super(parent, style);
	}

	public EditOrientationComposite(Composite parent, int style, OrientationSensor orientationSensor) {
		super(parent, style);

		this.orientationSensor = orientationSensor;

		GridLayout gridLayout = new GridLayout();
		gridLayout.numColumns = 2;
		this.setLayout(gridLayout);

		Label xLabel = new Label(this, SWT.NONE);
		xLabel.setText("X Rotation (deg):");

		GridData gridDataX = new GridData();
		gridDataX.widthHint = 100;
		gridDataX.horizontalAlignment = org.eclipse.swt.layout.GridData.FILL;
		this.xValueText = new Text(this, SWT.BORDER);
		this.xValueText.setLayoutData(gridDataX);
		this.xValueText
				.setText(Double.toString(Math.toDegrees(orientationSensor.getOrientationCoordinates().getXRotation())));

		Label yLabel = new Label(this, SWT.NONE);
		yLabel.setText("Y Rotation (deg):");

		GridData gridDataY = new GridData();
		gridDataY.widthHint = 100;
		gridDataY.horizontalAlignment = org.eclipse.swt.layout.GridData.FILL;
		this.yValueText = new Text(this, SWT.BORDER);
		this.yValueText.setLayoutData(gridDataY);
		this.yValueText
				.setText(Double.toString(Math.toDegrees(orientationSensor.getOrientationCoordinates().getYRotation())));

		Label zLabel = new Label(this, SWT.NONE);
		zLabel.setText("Z Rotation (deg):");

		GridData gridDataZ = new GridData();
		gridDataZ.widthHint = 100;
		gridDataZ.horizontalAlignment = org.eclipse.swt.layout.GridData.FILL;
		this.zValueText = new Text(this, SWT.BORDER);
		this.zValueText.setLayoutData(gridDataZ);
		this.zValueText
				.setText(Double.toString(Math.toDegrees(orientationSensor.getOrientationCoordinates().getZRotation())));

		this.setSize(new Point(300, 200));
	}

	public CartesianOrientationCoordinates getNewValues() {
		CartesianOrientationCoordinates orientation = ApogyCommonGeometryData3DFacade.INSTANCE
				.createCartesianOrientationCoordinates(this.orientationSensor.getOrientationCoordinates());

		try {
			double xRotation = Math.toRadians(Double.parseDouble(this.xValueText.getText()));
			double yRotation = Math.toRadians(Double.parseDouble(this.yValueText.getText()));
			double zRotation = Math.toRadians(Double.parseDouble(this.zValueText.getText()));

			orientation = ApogyCommonGeometryData3DFacade.INSTANCE.createCartesianOrientationCoordinates(xRotation,
					yRotation, zRotation);
		} catch (Exception e) {

		}

		return orientation;
	}
}