#include <QFileDialog>
/*
- * Vector class
+ * Vector class.
+ * In starting Qt 4.6 there is QVector3D.
+ * Later (updating Qt version) this class can be removed.
*/
class Vector
{
qreal angle;
public:
qreal getOffsx() { return offsx; };
- qreal getOffsy() { return offsx; };
+ qreal getOffsy() { return offsy; };
qreal getOffsz() { return offsz; };
qreal getDval() { return dval; };
void setAngle( qreal newA) { angle = newA; };
offsx = -a1.getX()*fromPoint.getX() - a1.getY()*fromPoint.getY() - a1.getZ()*fromPoint.getZ();
offsy = -a2.getX()*fromPoint.getX() - a2.getY()*fromPoint.getY() - a2.getZ()*fromPoint.getZ();
offsz = -a3.getX()*fromPoint.getX() - a3.getY()*fromPoint.getY() - a3.getZ()*fromPoint.getZ();
- QString jono2 = QString("offsx %1 offsy %2 offsz %3").arg(offsx).arg(offsy).arg(offsz);
- QMessageBox::about(0,"offs x y z", jono2);
+ //QString jono2 = QString("offsx %1 offsy %2 offsz %3").arg(offsx).arg(offsy).arg(offsz);
+ //QMessageBox::about(0,"offs x y z", jono2);
} ;
Vector getAtPoint() { return atPoint; };
Vector getFromPoint() { return fromPoint; };
QList<Vector> vertexList; // Vertecies of route
-//Vector atPoint, fromPoint, up, a1, a2, a3;
-//qreal offsx, offsy, offsz;
-
-qreal objxmin, objxmax, objymin, objymax, objzmin, objzmax;
-//qreal angle;
-qreal a, b,c,d; //, dval;
+qreal objxmin, objxmax, objymin, objymax, objzmin, objzmax; // data ranges
#define maxof(val1,val2) ((val1>val2)?val1:val2)
#define toradians( degrees) (degrees*0.017453293)
-#define WIDTH 1.8
+#define WIDTH 1.8 // For 3d viewing only
+qreal a, b,c,d; // Used for 3d viewing to calculate screen coordinates
-int length = 34; // 24;
-int connection[50];
+Viewing view3d; // Viewing settings for 3d
+// Function prototypes
+void dataMinMax( void);
void setAtPoint( Viewing *v);
void setFromPoint( Viewing *v);
-//void setEye();
+void transformseg( Viewing *v, Vector *v1, Vector *v2, int *xscreen1, int *yscreen1, int *xscreen2, int *yscreen2 );
-Viewing view3d;
+#define R 6378.140 // The radius of the earth by kilometers
+/*
+ * count distance of two points (defined by longitude & latitude)
+ * on the surface of the earth.
+ */
+qreal countDistance(Vector *p1, Vector *p2)
+{
+ qreal dLon, dLat; // delta of longitude & latitude
+ qreal a, c;
-void dataMinMax( void);
+ dLon = p2->getX() - p1->getX(); // longitude difference
+ dLat = p2->getY() - p1->getY(); // latitude difference
+ if (dLon <0) dLon = -dLon;
+ if (dLat <0) dLat = -dLat;
+ dLon = dLon*3.14/180;
+ dLat = dLat*3.14/180;
+ a = (sin(dLat/2.))*(sin(dLat/2.)) +
+ (cos(p1->getY())*3.14/180)*(cos(p2->getY())*3.14/180)*(sin(dLon/2.))*(sin(dLon/2.));
+ c = 2.*atan(sqrt(a)/sqrt(1-a)); // c is angle between points p1 & p2 with circel by radius 1.
+ return R*c; // Return distance in kilometers
+}
RouteDialog::RouteDialog(QWidget *parent) :
QDialog(parent),
/**
- * Draws route to the route dialog
+ * Draws route to the route dialog.
+ * Type 0 is 2d viewing and type 1 is for 3d viewing
* @param QPaintEvent
*/
/* */
void RouteDialog::paintEvent(QPaintEvent *)
{
- // 2d draw
+ int type = 0; // 0 for 2d, 1 for 3d
int startx, starty; // Starting point of the route
int i, maxi;
qreal x1, y1, x2, y2;
- int scx1, scy1, scx2, scy2;
+ int x1Screen, y1Screen, x2Screen, y2Screen;
Vector v1, v2;
QPainter painter(this);
painter.setRenderHint(QPainter::Antialiasing, true);
- painter.setPen(QPen((Qt::white),2));
+ painter.setPen(QPen((Qt::black),2));
painter.setBrush(QBrush((Qt::yellow), Qt::SolidPattern));
// Draw route window frame
painter.drawLine(left,top,left,bottom);
painter.drawLine(left,bottom,right,bottom);
*/
+ maxi = vertexList.size();
- maxi = vertexList.size()-1; // -1 to remove wrong last point !!!
for (i=0; i<maxi-1; i++)
{
- v1 = vertexList.at(i);
- v2 = vertexList.at(i+1);
- x1 = v1.getX(); y1 = v1.getY();
- x2 = v2.getX(); y2 = v2.getY();
- //QString jono = QString("x: %1 y: %2").arg(x1).arg(y1);
- //QMessageBox::about(0,"Tark",jono);
-
- scx1 = left + (x1-xmin)/(xmax-xmin)*(right-left);
- scy1 = top + (ymax-y1)/(ymax-ymin)*(bottom-top);
- scx2 = left + (x2-xmin)/(xmax-xmin)*(right-left);
- scy2 = top + (ymax-y2)/(ymax-ymin)*(bottom-top);
+ v1 = vertexList.at(i);
+ v2 = vertexList.at(i+1);
+
+ if (type == 0)
+ { // 2d
+ x1 = v1.getX(); y1 = v1.getY();
+ x2 = v2.getX(); y2 = v2.getY();
+ //QString jono = QString("x: %1 y: %2").arg(x1).arg(y1);
+ //QMessageBox::about(0,"Tark",jono);
+
+ x1Screen = left + (x1-xmin)/(xmax-xmin)*(right-left);
+ y1Screen = top + (ymax-y1)/(ymax-ymin)*(bottom-top);
+ x2Screen = left + (x2-xmin)/(xmax-xmin)*(right-left);
+ y2Screen = top + (ymax-y2)/(ymax-ymin)*(bottom-top);
+ }
+ else if (type == 1)
+ { // 3d
+ transformseg( &view3d, &v1,&v2, &x1Screen, &y1Screen, &x2Screen, &y2Screen);
+ }
// Show with circle if starting point
if (i==0)
{
// Starting point
- startx = scx1; starty = scy1;
- painter.drawEllipse( scx1-5, scy1-5, 10, 10);
+ startx = x1Screen; starty = y1Screen;
+ painter.drawEllipse( x1Screen-5, y1Screen-5, 10, 10);
}
- painter.drawLine( scx1, scy1, scx2, scy2);
+ painter.drawLine( x1Screen, y1Screen, x2Screen, y2Screen);
}
// Show the endig point if different than the starting point
- if (scx2 != startx || scy2 != starty)
+ if (x2Screen != startx || y2Screen != starty)
{
- painter.drawEllipse( scx2-5, scy2-5, 10, 10);
+ painter.drawEllipse( x2Screen-5, y2Screen-5, 10, 10);
}
}
-/* */
void RouteDialog::on_closePushButton_clicked()
{
close();
}
+/*
+ * Read route coordinates (latitude, longitude, altitude) from file.
+ */
bool RouteDialog::readRouteFromFile( QString &filename)
{
-/* 2d */
Vector temp;
- int i;
QString rivi;
QFile file;
- //file.setFileName("route.txt");
+
QString fileName = QFileDialog::getOpenFileName(this,
- tr("Read Route"), "./", tr("Route Files (*.txt)"));
+ tr("Read Route"), "./", tr("Route Files (*.txt)"));
file.setFileName( fileName);
if (!file.open(QIODevice::ReadOnly))
}
vertexList.clear();
- i = 0;
- //while( file.canReadLine())
while(!file.atEnd())
{
QString str1, str2, str3;
rivi = file.readLine();
str1 = rivi.section(" ", 0, 0);
- if (str1.compare("Start:") == 0 || str1.compare("Stop:") == 0)
+ if (str1.compare("Start:") != 0 && str1.compare("Stop:") != 0)
{
-
- }
- else
- {
- //QMessageBox::about(0, "LUKEE", file.readLine());
str1 = rivi.section(" ", 2, 2); // latitude y-value
str2 = rivi.section(" ", 4, 4); // longitude x-value
str3 = rivi.section(" ", 6, 6); // altitude z-value
- QString str = QString("la: %1 lo: %2 al: %3").arg(str1).arg(str2).arg(str3);
+ //QString str = QString("la: %1 lo: %2 al: %3").arg(str1).arg(str2).arg(str3);
//QMessageBox::about(0, "LUKEE", str);
- double x, y, z;
- x = str2.toDouble();
- y = str1.toDouble();
- z = str3.toDouble();
- temp.setX( x); // Longitude
- temp.setY( y);// Latitude
- temp.setZ( z);// altitude
-
- vertexList.append(temp);
+ if (str1.length() > 0)
+ {
+ double x, y, z;
+ x = str2.toDouble();
+ y = str1.toDouble();
+ z = str3.toDouble();
+ temp.setX( x); // Longitude
+ temp.setY( y); // Latitude
+ temp.setZ( z); // altitude
+
+ vertexList.append(temp);
+ }
}
- i++;
}
- // la: lo: al:
file.close();
- /* */
- /* for 3D test */
- /*vertexList.append(Vector(0.0, 0.0, 0.0));
- vertexList.append(Vector(1.0, 1.0, 1.0));
- vertexList.append(Vector(1.0, 1.0, 0.0));
-
- vertexList.append(Vector(1.0, 0.0, 0.0));
- vertexList.append(Vector(1.0, 0.0, 1.0));
- vertexList.append(Vector(0.0, 1.0, 1.0));
-
- vertexList.append(Vector(0.0, 1.0, 0.0));
- vertexList.append(Vector(0.0, 0.0, 0.0));
- vertexList.append(Vector(0.0, 0.0, 1.0));
-*/
- /* For 3d */
- //int i;
- for(i= 0; i<35; i++)
- {
- connection[i] = i;
- }
- /* connection[0] = 0;
- connection[1] = 1; connection[2] = 5; connection[3] = 8; connection[4] = -4;
- connection[5] = 5; connection[6] = 6; connection[7] = 7; connection[8] = -8;
- connection[9] = 6; connection[10] = 2; connection[11] = 3; connection[12] = -7;
- connection[13] = 1; connection[14] = 4; connection[15] = 3; connection[16] = -2;
- connection[17] = 8; connection[18] = 7; connection[19] = 3; connection[20] = -4;
- connection[21] = 6; connection[22] = 5; connection[23] = 1; connection[24] = -2;*/
-
/******** in 3d use only */
a = 400/2.;
b = 1 - a*(-1);
d = 300 - c*(-1);
//angle = toradians(60);
- view3d.setUp( 0.0, 0.0, 1.0);
+ view3d.setUp( 1.0, 0.0, 0.0);
view3d.setAngle(toradians(60));
setAtPoint( &view3d);
- xmin = objxmin; xmax = objxmax; ymin = objymin; ymax = objymax;
+ xmin = objxmin; xmax = objxmax; ymin = objymin; ymax = objymax; // 2d viewing needs this !!!!
setFromPoint( &view3d);
view3d.setEye();
/****** end of 3d *****/
+
+ /*
+ //Testing distance counting
+ Vector a1, a2;
+ qreal dist;
+ //a1.setX( xmin); a1.setY( ymin);
+ //a2.setX( xmax); a2.setY( ymax);
+ a1.setX( 25.483); a1.setY( 65.017); // Oulu
+ a2.setX( 27.767); a2.setY( 64.283); // Kajaani
+ dist = countDistance( &a1, &a2);
+ QString str = QString("Min & Max datan välimatka %1").arg(dist);
+ QMessageBox::about( 0, "Testi", str);
+ */
+
return true;
}
objymax = objymin = temp.getY();
objzmax = objzmin = temp.getZ();
- maxi = vertexList.size()-1; // Wrong last data
- //maxi = 9;
+ maxi = vertexList.size();
for (i=1; i<maxi; i++)
{
temp = vertexList.at(i);
//QMessageBox::about(0,"Tark", jono);
}
-
+/*
+ * Setting the point where the viewed object is. In the middle of datapoints.
+ */
void setAtPoint( Viewing *v)
{
qreal x, y, z;
dataMinMax();
- Vector test;
- //atPoint.setX((
- x = (objxmax+objxmin)/2.0;
- //atPoint.setY(
- y= (objymax+objymin)/2.0;
- //atPoint.setZ(
- z= (objzmax+objzmin)/2.0;
- v->setAtPoint( x, y, z);
+ //Vector test;
+
+ x = (objxmax+objxmin)/2.0;
+ y= (objymax+objymin)/2.0;
+ z= (objzmax+objzmin)/2.0;
+
+ v->setAtPoint( x, y, z);
//QString jono = QString("AtX %1 Aty %2 AtZ %3").arg(atPoint.x()).arg(atPoint.y()).arg(atPoint.z());
//QString jono = QString("AtX %1 Aty %2 AtZ %3").arg(atPoint.x).arg(atPoint.y).arg(atPoint.z);
* */
}
+/*
+ * Setting the point where the object is viewed by eye.
+ */
void setFromPoint( Viewing *v)
{
qreal x, y, z;
Vector point;
point = v->getAtPoint();
- Vector test;
+ //Vector test;
//fromPoint.setX( atPoint.getX() + (objxmax-objxmin)/2.0 + WIDTH*maxof((objzmax-objzmin)/2.0,(objymax-objymin)/2.0));
- //fromPoint.setX(
- //x = 3.0;
- x = point.getX() + 300; //25;
- //fromPoint.setY(
- y = point.getY();
- //fromPoint.setZ(
- z = point.getZ(); // + 150;
- v->setFromPoint(x,y,z);
+ //x = 3.0;
+ //x = point.getX() + (objxmax-objxmin)/2.0 + WIDTH*maxof((objzmax-objzmin)/2.0,(objymax-objymin)/2.0);
+ x = point.getX();
+ //y = point.getY();
+ y = point.getY() + 40; // + (objymax-objymin)/2.0 + WIDTH*maxof((objzmax-objzmin)/2.0,(objxmax-objxmin)/2.0);
+ z = point.getZ();
+
+ v->setFromPoint(x,y,z);
//QString jono = QString("FromX %1 FromY %2 FromZ %3").arg(fromPoint.x()).arg(fromPoint.y()).arg(fromPoint.z());
//QString jono = QString("FromX %1 FromY %2 FromZ %3").arg(fromPoint.x).arg(fromPoint.y).arg(fromPoint.z);
/* *
* */
}
-/*void setEye()
-{
- double amarkmag, tempmag;
- Vector temp, dist;
-
- dval = cos(angle/2.0)/sin(angle/2.0);
- dist = atPoint-fromPoint;
- amarkmag = dist.length();
- a3 = dist/amarkmag;
-
- temp.crossProduct( dist, up);
- tempmag = temp.length();
- a1 = temp/tempmag;
-
- temp.crossProduct( a1, a3);
- tempmag = temp.length();
- a2 = temp/tempmag;
-
- offsx = -a1.getX()*fromPoint.getX() - a1.getY()*fromPoint.getY() - a1.getZ()*fromPoint.getZ();
- offsy = -a2.getX()*fromPoint.getX() - a2.getY()*fromPoint.getY() - a2.getZ()*fromPoint.getZ();
- offsz = -a3.getX()*fromPoint.getX() - a3.getY()*fromPoint.getY() - a3.getZ()*fromPoint.getZ();
- //QString jono2 = QString("offsx %1 offsy %2 offsz %3").arg(offsx).arg(offsy).arg(offsz);
- //QMessageBox::about(0,"offs x y z", jono2);
-}*/
#define NOEDGE 0x00
#define LEFTEDGE 0x01
return c;
}
+
/*
* Converts clipped world coordinates to screen coordinates.
*/
WORLDtoSCREEN(x1,y1,xscreen1, yscreen1);
WORLDtoSCREEN(x2,y2,xscreen2, yscreen2);
}
- //line( xscreen1, yscreen1, xscreen2, yscreen2);
+ //Now ready to draw line( xscreen1, yscreen1, xscreen2, yscreen2);
}
/*
* Transform the segment connecting the two vectors into the viewing plane.
* clip3d() clips the line if needed.
*/
-void transformseg( Viewing *v, Vector *v1, Vector *v2, int *xscreen1, int *yscreen1, int *xscreen2, int *yscreen2 )
+void transformseg( Viewing *v, Vector *v1, Vector *v2, int *xscreen1, int *yscreen1, int *xscreen2, int *yscreen2)
{
qreal x1, y1, z1, x2, y2, z2;
- qreal offsx, offsy, offsz;
- qreal dval;
Vector a1, a2, a3;
+
a1 = v->getA1();
a2 = v->getA2();
a3 = v->getA3();
- offsx = v->getOffsx();
- offsy = v->getOffsy();
- offsz = v->getOffsz();
- dval = v->getDval();
- x1 = (a1.getX()*v1->getX() + a1.getY()*v1->getY() + a1.getZ()*v1->getZ() + offsx)*dval;
- y1 = (a2.getX()*v1->getX() + a2.getY()*v1->getY() + a2.getZ()*v1->getZ() + offsy)*dval;
- z1 = a3.getX()*v1->getX() + a3.getY()*v1->getY() + a3.getZ()*v1->getZ() + offsz;
+ x1 = (a1.getX()*v1->getX() + a1.getY()*v1->getY() + a1.getZ()*v1->getZ() + v->getOffsx())*v->getDval();
+ y1 = (a2.getX()*v1->getX() + a2.getY()*v1->getY() + a2.getZ()*v1->getZ() + v->getOffsy())*v->getDval();
+ z1 = a3.getX()*v1->getX() + a3.getY()*v1->getY() + a3.getZ()*v1->getZ() + v->getOffsz();
- x2 = (a1.getX()*v2->getX() + a1.getY()*v2->getY() + a1.getZ()*v2->getZ() + offsx)*dval;
- y2 = (a2.getX()*v2->getX() + a2.getY()*v2->getY() + a2.getZ()*v2->getZ() + offsy)*dval;
- z2 = a3.getX()*v2->getX() + a3.getY()*v2->getY() + a3.getZ()*v2->getZ() + offsz;
+ x2 = (a1.getX()*v2->getX() + a1.getY()*v2->getY() + a1.getZ()*v2->getZ() + v->getOffsx())*v->getDval();
+ y2 = (a2.getX()*v2->getX() + a2.getY()*v2->getY() + a2.getZ()*v2->getZ() + v->getOffsy())*v->getDval();
+ z2 = a3.getX()*v2->getX() + a3.getY()*v2->getY() + a3.getZ()*v2->getZ() + v->getOffsz();
clip3d(x1,y1,z1,x2,y2,z2, xscreen1, yscreen1, xscreen2, yscreen2 );
}
-
-/*
- *
- * 3D route viewing
-*
-void RouteDialog::paintEvent(QPaintEvent *)
-{
- int i, startofside;
- int xscreen1, yscreen1, xscreen2, yscreen2;
- Vector temp1, temp2;
-
- QPainter painter(this);
-
- painter.setRenderHint(QPainter::Antialiasing, true);
- painter.setPen(QPen((Qt::black),2));
- painter.setBrush(QBrush((Qt::yellow), Qt::SolidPattern));
-
- // Draw route window frsme
- //painter.drawLine(left,top,right,top);
- //painter.drawLine(right,top,right,bottom);
- //painter.drawLine(left,top,left,bottom);
- //painter.drawLine(left,bottom,right,bottom);
-
- i = 1;
- while (i<length)
- {
- temp1 = vertexList.at(connection[i-1]);
- temp2 = vertexList.at(connection[i]);
- transformseg( &view3d, &temp1,&temp2, &xscreen1, &yscreen1, &xscreen2, &yscreen2);
-
- painter.drawLine(xscreen1, yscreen1, xscreen2, yscreen2);
- if (i==1)
- {
- painter.drawEllipse( xscreen1-5, yscreen1-5, 10, 10);
- }
- i++;
- }
- /*
- i=1;
- while(i<length)
- {
- startofside = i;
- i++;
- while (connection[i] > 0)
- {
- //transformseg( &pa[connection[i-1]],&pa[connection[i]], &xpc1, &ypc1, &xpc2, &ypc2);
- temp1 = vertexList.at(connection[i-1]);
- temp2 = vertexList.at(connection[i]);
- transformseg( &view3d, &temp1,&temp2, &xscreen1, &yscreen1, &xscreen2, &yscreen2);
-
- painter.drawLine(xscreen1, yscreen1, xscreen2, yscreen2);
- if (i==2)
- {
- painter.drawEllipse( xscreen1-5, yscreen1-5, 10, 10);
- }
- i++;
- }
- // to last segment
- //transformseg( &pa[connection[i-1]],&pa[-connection[i]],&xpc1, &ypc1, &xpc2, &ypc2);
- temp1 = vertexList.at(connection[i-1]);
- temp2 = vertexList.at(-connection[i]);
- transformseg( &view3d, &temp1,&temp2, &xscreen1, &yscreen1, &xscreen2, &yscreen2);
- painter.drawLine(xscreen1, yscreen1, xscreen2, yscreen2);
- // from last segemt to start
- //transformseg( &pa[-connection[i]],&pa[connection[startofside]],&xpc1, &ypc1, &xpc2, &ypc2);
- temp1 = vertexList.at(-connection[i]);
- temp2 = vertexList.at(connection[startofside]);
- transformseg( &view3d, &temp1,&temp2, &xscreen1, &yscreen1, &xscreen2, &yscreen2);
- painter.drawLine(xscreen1, yscreen1, xscreen2, yscreen2);
- i++;
- }
- *
-}
-** */