Application: gvSIG desktop

package org.cresques.px.dxf;

import java.awt.geom.Point2D;

import java.lang.Math;

import org.cresques.geo.Point3D;

public class DxfCalXtru {

        public static Point2D CalculateXtru(Point3D coord_in, Point3D xtru) {

                Point2D coord_out = new Point2D.Double();

        double dxt0 = 0D, dyt0 = 0D, dzt0 = 0D;

        double dvx1, dvx2, dvx3;

        double dvy1, dvy2, dvy3;

        double dmod, dxt, dyt, dzt;

        double aux = 1D/64D; //LWS

        double aux1 = Math.abs(xtru.getX());

        double aux2 = Math.abs(xtru.getY());

        dxt0 = coord_in.getX();

        dyt0 = coord_in.getY();

        dzt0 = coord_in.getZ();

        double xtruX, xtruY, xtruZ;

        xtruX = xtru.getX();

        xtruY = xtru.getY();

        xtruZ = xtru.getZ();

        if ((aux1 < aux) && (aux2 < aux)) {

            dmod = Math.sqrt(xtruZ*xtruZ + xtruX*xtruX);

            dvx1 = xtruZ / dmod;

            dvx2 = 0;

            dvx3 = -xtruX / dmod;

        } else {

            dmod = Math.sqrt(xtruY*xtruY + xtruX*xtruX);

            dvx1 = -xtruY / dmod;

            dvx2 = xtruX / dmod;

            dvx3 = 0;

        }

        dvy1 = xtruY*dvx3 - xtruZ*dvx2;

        dvy2 = xtruZ*dvx1 - xtruX*dvx3;

        dvy3 = xtruX*dvx2 - xtruY*dvx1;

        dmod = Math.sqrt(dvy1*dvy1 + dvy2*dvy2 + dvy3*dvy3);

        dvy1 = dvy1 / dmod;

        dvy2 = dvy2 / dmod;

        dvy3 = dvy3 / dmod;

        dxt = dvx1*dxt0 + dvy1*dyt0 + xtruX*dzt0;

        dyt = dvx2*dxt0 + dvy2*dyt0 + xtruY*dzt0;

        dzt = dvx3*dxt0 + dvy3*dyt0 + xtruZ*dzt0;

        coord_out.setLocation(dxt, dyt);

        //coord_out.z = dzt;

        dxt0 = 0;

        dyt0 = 0;

        dzt0 = 0;

                return coord_out;

        }

    public static double cosDeg(double alfa) {

            final double toRad = Math.PI/(double)180.0;

            return Math.cos(alfa*toRad);

    }

    public static double sinDeg(double alfa) {

            final double toRad = Math.PI/(double)180.0;

            return Math.sin(alfa*toRad);

    }

    public static void CalculateArc(double[] dat, double r, double angulo) {

            dat[1] = dat[1] + r * Math.sin(angulo*Math.PI/(double)180.0);

            dat[0] = dat[0] + r * Math.cos(angulo*Math.PI/(double)180.0);

    }

}