VisClient/org/hfbk/vis/visnode/VisRoute.java

Go to the documentation of this file.

/*
 * Created on 25.04.2005
 *
 */
package org.hfbk.vis.visnode;

import java.io.BufferedReader;
import java.io.File;
import java.io.FileNotFoundException;
import java.io.FileReader;
import java.text.DateFormat;
import java.text.SimpleDateFormat;
import java.util.ArrayList;
import java.util.Date;
import java.util.regex.Matcher;
import java.util.regex.Pattern;

import org.dronus.gl.GLBoxRenderer;
import org.dronus.graph.Node;
import org.lwjgl.opengl.GL11;
import org.lwjgl.util.vector.Vector3f;

public class VisRoute extends VisNode{
        
        static float centerx, centery;
        static int count;
        
        int dl;
        
        public LatLon[] pts;

        float mx,my,baseRadius;

        long time;
        int index;
        
        
        
        static public class LatLon {
                
                final double JUMP=50; //distance to consider node a jump. 
                
                long time;
                double  x,y;
                boolean skip;

                final static double LAT_TOLERANCE=0.0000001;
                
                boolean isSkip(LatLon last){
                        
                        boolean jump=false;
                        
                        if(last!=null)
                                jump=Math.abs(last.x-x)+Math.abs(last.y-y)>JUMP;
                        
                        return skip || jump;
                }
        
                LatLon(double lat, double lon, boolean skip, long time) {
                        this.time=time;
                        this.skip=skip;
                        x=lonToX(lon);  y=latToY(lat);
                }

                /*LatLon(String latLon){
                        y=latToY(new Double(latLon.split(" ")[0]));
                        x=lonToX(new Double(latLon.split(" ")[1]));             
                }*/
                
                private static double lonToX(double l) {
                        return (0.02912711127225e+5d*l+5.24287987005829e+5d);
                }

                private static double latToY(double l) {
                        return  
                         -0.000000000000755295599727381190d             *l*l*l*l*l*l*l*l*l
                         +0.000000000052641300469669939483d             *l*l*l*l*l*l*l*l
                         +0.000000000075316265389785703085d             *l*l*l*l*l*l*l
                         -0.000000211768858757441037921488d             *l*l*l*l*l*l
                         -0.000007406891366988815666918405d             *l*l*l*l*l
                         +0.000195348752382833688867602717d             *l*l*l*l
                         -0.154872228716328858011408442508d             *l*l*l
                         -0.005034130049192665941337754276d             *l*l
                         -2910.198469731275963567895814776421d  *l
                         +524263.229158876347355544567108154297d;
                }
                
                
/*              public double getLon(){
                        return   ((x/tilesize)-5.24287987005829e+5d)/0.02912711127225e+5d;
                }
                
                public double getLat(){
                        double ll=-90, rl=90, m=0;
                        int i=0;
                        while (rl-ll>LAT_TOLERANCE){
                                i++;
                                m=(ll+rl)/2;
                                if (latToY(m)>y)
                                        ll=m;
                                else 
                                        rl=m;                           
                        }
                        //System.out.println("getLat() needed "+i+" iterations.");
                        return m;
                }
        
                public String toString(){               
                        return String.format((Locale)null,"%f5 %f5",getLat(),getLon());
                }
        */      
                static double parseDMS(String d, String m, String s){
                        double v=Double.parseDouble(d);
                        v+=Double.parseDouble(m)/60;
                        v+=Double.parseDouble(s)/3600;
                        return v;
                }
        }

        
        
        public VisRoute(Node node, Vector3f pos) {
                super(null, pos);
                
                File f=new File(node.text);
                ArrayList<LatLon> pl = new ArrayList<LatLon>();
                
                try {
                        BufferedReader s = new BufferedReader(new FileReader(f));
                        String l;
                        l = s.readLine();
                        double lat, lon;
                        long t=0;
                        if (l.charAt(0) == 'W') {// very new format...... :-(
                                System.out.println("very new format");
                                Pattern   timeMatcher=Pattern.compile("(\\d+/\\d+/\\d+ \\d+:\\d+:\\d+)"),
                                                latLonMatcher=Pattern.compile("(\\d+?).(\\d+)'([\\d\\.]+)\"");                          
                                while ((l = s.readLine()) != null) {
                                        Matcher m=timeMatcher.matcher(l);
                                        if (m.find()) {
                                                DateFormat df=new SimpleDateFormat("dd/MM/yyyy hh:mm:ss");
                                                df.setLenient(true);
                                                Date d=df.parse(m.group(1));
                                                t=d.getTime();
                                        }
                                        m=latLonMatcher.matcher(l);
                                        if (m.find()){
                                                lat=LatLon.parseDMS(m.group(1),m.group(2),m.group(3));
                                                m.find();
                                                lon=LatLon.parseDMS(m.group(1),m.group(2),m.group(3));
                                                
                                                pl.add(new LatLon(lat, lon, false, t));
                                        }
                                }
                        } else {
                                while ((l = s.readLine()) != null) {
                                        
                                        String[] args=l.split(",");
                                        
                                        
                                        if (args.length<2) continue;                                    
                                        if (!args[0].equals("t"))       continue;                                       
                                        if (!args[1].equals("d"))       throw new RuntimeException("wrong datum");
                                        
                                        lat = Double.parseDouble(args[2]);
                                        lon = Double.parseDouble(args[3]);
                                        // skip point if not connected
                                        boolean skip = Integer.parseInt(args[7]) == 1;

                                        pl.add(new LatLon(lat, lon, skip, t));
                                }
                        }
                } catch (Exception e) {
                        if (e instanceof FileNotFoundException)
                                System.out.println("file not found:" + f.toString());
                        else
                                System.out.println("not a valid track-file.");
                        e.printStackTrace();
                }
                pts = (LatLon[]) pl.toArray(new LatLon[0]);
        }

        
        @Override
        void transform() {
                super.transform();
                //GL11.glTranslatef(50,0,-50);
                GL11.glRotatef(-51.5f, 0,1,0);
                GL11.glScalef(100,100,100);             
        }
        
        void renderSelf() {
                
                if (dl==0){
                        dl=GL11.glGenLists(1);
                        GL11.glNewList(dl, GL11.GL_COMPILE);
                        int n=pts.length;
                        if (n>0){
                                for (LatLon gk : pts){
                                        double x=gk.x,y=gk.y;
                                        mx+=x;  my+=y;
                                }
                                
                                mx/=n;  my/=n;
//                              update global lat/lon center
                                count++;
                                centerx=(centerx*(count-1)+mx)/count;
                                centery=(centery*(count-1)+my)/count;
                                
                                for (LatLon gk : pts){
                                        double dx=gk.x-mx,dy=gk.y-my;
                                        float r=(float)Math.sqrt(dx*dx+dy*dy);
                                        baseRadius=Math.max(baseRadius, r);
                                }
                        }
                        
                        // double s=1d/(1L<<LeinMap.earthlevel);
                        int i = 0;
                        LatLon last=null;
                        GL11.glColor3f(0,1,1);
                        GL11.glBegin(GL11.GL_LINE_STRIP);
                        if (pts.length > 0)
                                for (LatLon gk : pts){
                                        if (i++ == 0 || gk.isSkip(last)){
                                                GL11.glEnd();           
                                                GL11.glBegin(GL11.GL_LINE_STRIP);
                                        }
                                        else
                                                GL11.glVertex3d(gk.x-mx,0,gk.y-my);
                                        last=gk;
                                }
                        GL11.glEnd();
                        GL11.glEndList();
                }
                
                
                
                
                
//              calculate global position by moving our center relative to global center
                float x=mx-centerx, y=my-centery;
                radius=1000000;//baseRadius+(float)Math.sqrt(x*x+y*y);
                GL11.glTranslatef(x, 0, y);
                
                GL11.glDisable(GL11.GL_TEXTURE_2D);
                GL11.glCallList(dl);


                if ((time==0)|(index>pts.length)) {
                        time=pts[0].time;
                        index=1;
                }

                time+=getRoot().client.dt*1000d;
                
                LatLon last=pts[index-1];
                LatLon next=pts[index];
                
                long dt=time-last.time;
                float p=dt/(float)(next.time-last.time);
                
                if (p>1){
                        index=index%(pts.length-2)+1;
                }
                x=(float)(last.x*(1-p)+next.x*p)-mx;
                y=(float)(last.y*(1-p)+next.y*p)-my;
        
                double dx=next.x-last.x;
                double dy=next.y-last.y;
                
                GL11.glPushMatrix();
                GL11.glTranslated(x,0,y);
                float atan=(float)Math.atan(dx/dy);
                if (dy<0) atan+=Math.PI;
                GL11.glRotatef((float)(180*atan/Math.PI),0,1,0);                
                GL11.glColor3f(1,0.5f,0);
                GLBoxRenderer.renderBox(1,1,2);
                GL11.glPopMatrix();
                
        /*      if (children.size()>0){
                        VisNode n=children.get(0);
                        n.position.set(x+(mx-centerx),8,y+(my-centery));
                        
                        if (n instanceof VisVideo) {
                                VisVideo v=(VisVideo)n;
                                if (v.tex!=null){
                                        time=v.tex.currenttime+pts[0].time;                                     
                                }
                        }                       
                }
                */
        }
}

---