Application: gvSIG desktop » gvSIG 3D

/* gvSIG 3D extension for gvSIG

 *

 * Copyright (C) 2012 Prodevelop.

 *

 * 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 2

 * 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, write to the Free Software

 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307,USA.

 *

 * For more information, contact:

 *

 *   Prodevelop, S.L.

 *   Pza. Don Juan de Villarrasa, 14 - 5

 *   46001 Valencia

 *   Spain

 *

 *   +34 963 510 612

 *   +34 963 510 968

 *   prode@prodevelop.es

 *   http://www.prodevelop.es

 */

/*

 * AUTHORS:

 * 2012 AI2 - Instituto Universitario de Automatica e Informatica Industrial.

 * Universitat Politecnica de Valencia (UPV)

 * http://www.ai2.upv.es

 */

package org.gvsig.gvsig3d.impl.compass;

import org.gvsig.gvsig3d.compass.Compass;

import org.gvsig.gvsig3d.resources.ResourcesFactory;

import org.gvsig.osgvp.core.osg.Matrix;

import org.gvsig.osgvp.core.osg.MatrixTransform;

import org.gvsig.osgvp.core.osg.PositionAttitudeTransform;

import org.gvsig.osgvp.core.osg.Quat;

import org.gvsig.osgvp.core.osg.Texture2D;

import org.gvsig.osgvp.core.osg.Vec3;

import org.gvsig.osgvp.core.osg.Vec4;

import org.gvsig.osgvp.exceptions.node.NodeException;

import org.gvsig.osgvp.features.Polygon;

import org.gvsig.osgvp.features.Quad;

import org.gvsig.osgvp.terrain.Terrain;

import org.gvsig.osgvp.viewer.Camera;

/**

 * Class to represent 3D axis (x,y,z) in the scene

 * 

 * @author Jesus Zarzoso- jzarzoso@ai2.upv.es

 * @version $Id$

 * 

 */

public class CompassImpl extends PositionAttitudeTransform implements Compass {

        private MatrixTransform _matrix;

        private Matrix _mat;

        private int _cameraType;

        private Terrain _terrain;

        public CompassImpl(Terrain terrain) throws NodeException {

                super();

                _matrix = new MatrixTransform();

                _terrain = terrain;

                Polygon pol = new Polygon();

                Quad quad = new Quad();

                Texture2D tex = new Texture2D();

                _cameraType = Compass.Mode.FLAT;

                // quad.addVertex(new Vec3(-0.5,-0.5,0.0), new Vec4(0.0,1.0,1.0,0.5));

                // quad.addVertex(new Vec3(0.5,-0.5,0.0), new Vec4(1.0,0.0,1.0,0.5));

                // quad.addVertex(new Vec3(0.5,0.5,0.0), new Vec4(1.0,1.0,0.0,0.5));

                // quad.addVertex(new Vec3(-0.5,0.5,0.0), new Vec4(1.0,0.0,1.0,0.5));

                pol.addVertex(new Vec3(-0.5, -0.5, 0.0), new Vec4(1.0, 1.0, 1.0, 1));

                pol.addVertex(new Vec3(0.5, -0.5, 0.0), new Vec4(1.0, 1.0, 1.0, 1));

                pol.addVertex(new Vec3(0.5, 0.5, 0.0), new Vec4(1.0, 1.0, 1.0, 1));

                pol.addVertex(new Vec3(-0.5, 0.5, 0.0), new Vec4(1.0, 1.0, 1.0, 1));

                // StateSet ss =quad.getOrCreateStateSet();

                // Image im;

                // try {

                // im = new Image(ResourcesFactory.getResourcePath("compass.png"));

                // tex.setImage(im);

                // } catch (LoadImageException e) {

                // // TODO Auto-generated catch block

                // e.printStackTrace();

                // } catch (ImageException e) {

                // // TODO Auto-generated catch block

                // e.printStackTrace();

                // }

                // quad.getOrCreateStateSet().setTextureMode(0, Node.Mode.ON |

                // Node.Mode.OVERRIDE);

                // quad.getOrCreateStateSet().setTexture2D(tex,0 , Node.Mode.ON);

                // _matrix.addChild(quad);

                pol.setTexture(ResourcesFactory.getResourcePath("compass.png"));

                pol.setEnabledBlending(true);

                _matrix.addChild(pol);

                _mat = new Matrix();

                this.addChild(_matrix);

        }

        public void setPanetType(int type) {

                _cameraType = type;

        }

        /**

         * Update compass rotation respect a camera.

         * 

         * @param camera

         */

        public void update(Camera camera) {

                Matrix auxmat = new Matrix();

                if (_cameraType == Compass.Mode.SPHERIC) {

                        Vec3 o, i, n, e, z, v, iTo;

                        o = camera.getEye();

                        i = _terrain.convertXYZToLatLongHeight(camera.getEye());

                        i = _terrain.convertLatLongHeightToXYZ(new Vec3(i.x(), i.y(), 0));

                        iTo = o.sub(i);

                        Vec3 northPole = _terrain.convertLatLongHeightToXYZ(new Vec3(90, 0,

                                        0));

                        z = i.sub(northPole);

                        e = iTo.crossProduct(z);

                        n = iTo.crossProduct(e);

                        v = camera.getCenter().sub(camera.getEye());

                        v.normalize();

                        double vX, vY;

                        vX = v.dotProduct(e) / e.length();

                        vY = v.dotProduct(n) / n.length();

                        double ang = Math.atan2(vX, vY);

                        Quat quat = new Quat();

                        quat.makeRotate(ang, new Vec3(0, 0, 1));

                        auxmat.setRotate(quat);

                        _matrix.setMatrix(auxmat);

                }

                else {

                        Vec3 look = camera.getCenter().sub(camera.getEye());

                        look.normalize();

                        Vec3 east = new Vec3(1, 0, 0);

                        Vec3 north = new Vec3(0, 1, 0);

                        double vX = look.dotProduct(east);

                        double vY = look.dotProduct(north);

                        double angle = Math.atan2(vX, vY);

                        Quat quat = new Quat();

                        quat.makeRotate(angle, new Vec3(0, 0, 1));

                        auxmat.setRotate(quat);

                        _matrix.setMatrix(auxmat);

                }

        }

}