comparison native/Falcon/utils.cpp @ 5:d66dd5880081

Added support for Falcon Haptic device and Tablet/Mouse as haptic device

+/*  
+ CCmI Editor - A Collaborative Cross-Modal Diagram Editing Tool
+  
+ Copyright (C) 2011  Queen Mary University of London (http://ccmi.eecs.qmul.ac.uk/)
+
+ This program is free software: you can redistribute it and/or modify
+ it under the terms of the GNU General Public License as published by
+ the Free Software Foundation, either version 3 of the License, or
+ (at your option) any later version.
+
+ This program is distributed in the hope that it will be useful,
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ GNU General Public License for more details.
+
+ You should have received a copy of the GNU General Public License
+ along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/  
+
+#include "utils.h"
+
+#define MAX(a,b) ((a) < (b) ? (b) : (a))
+#define MIN(a,b) ((a) > (b) ? (b) : (a))
+
+void checkExceptions(JNIEnv *env, char* what){
+	if(env->ExceptionOccurred()){
+		std::cout << "Exception occurred!!!" << std::endl;
+		std::cout << what << std::endl;
+		env->ExceptionDescribe();
+		exit(-1);
+	}
+}
+
+void stopExecution(char* msg){
+	std::cerr << msg << std::endl;
+	exit(-1);
+}
+
+H3DUtil::ArithmeticTypes::Vec3d & screenToHapticSpace(H3DUtil::ArithmeticTypes::Vec3d & aPoint, int w, int h){
+	int scale = MAX(w,h);
+	double x = (aPoint.x * .1 / scale) - .05;
+	/* in Java Swing (0,0) is the top-left corner, whereas in openGL and HAPI * 
+	 * (0,0) is the bottom-left corner. Therefore the y must be converted     */
+	aPoint.y = h - aPoint.y;
+	double y = (aPoint.y * .1 / scale) - .05;
+	
+	aPoint.x = x;
+	aPoint.y = y;
+	return aPoint;
+}
+
+H3DUtil::ArithmeticTypes::Vec3d & hapticToScreenSpace(H3DUtil::ArithmeticTypes::Vec3d & aPoint, int w, int h){
+	int scale = MAX(w,h);
+	double x = (aPoint.x + .05) * scale * 10;
+	double y = (aPoint.y + .05) * scale * 10;
+
+	aPoint.x = x;
+	/* in Java Swing (0,0) is the top-left corner, whereas in openGL and HAPI * 
+	 * (0,0) is the bottom-left corner. Therefore the y must be converted     */
+	aPoint.y = h - y;
+	return aPoint;
+}
+
+
+double pointsDistance(const H3DUtil::ArithmeticTypes::Vec3d & p, const H3DUtil::ArithmeticTypes::Vec3d & q){
+	/* 2D vectors are assumed */
+	return sqrt( (p.x - q.x)*(p.x - q.x)  +  (p.y - q.y)*(p.y - q.y) ) ;
+}
+
+H3DUtil::ArithmeticTypes::Vec3d midPoint(const H3DUtil::ArithmeticTypes::Vec3d & start, const H3DUtil::ArithmeticTypes::Vec3d & end){
+	/* 2D vectors are assumed */
+	double dx = abs((start.x - end.x)/2); 
+	double dy = abs((start.y - end.y)/2);
+	return H3DUtil::ArithmeticTypes::Vec3d( MIN(start.x,end.x)+dx , MIN(start.y,end.y)+dy , 0);
+}