X-Git-Url: http://git.maemo.org/git/?p=speedfreak;a=blobdiff_plain;f=Client%2Froutedialog.cpp;h=5a680aa0b66dd6f56d6343359db5c8ea5214f248;hp=62901749340bcb447a5cfe2847734290d50b5030;hb=fbb2c086a9df6bf96410bdc757ed8d3da61ab962;hpb=e5596c8e8492c120bb15c404d3e0142061ad09ab diff --git a/Client/routedialog.cpp b/Client/routedialog.cpp index 6290174..5a680aa 100644 --- a/Client/routedialog.cpp +++ b/Client/routedialog.cpp @@ -1,11 +1,182 @@ +/* + * RouteDialog class + * + * @author Olavi Pulkkinen + * @copyright (c) 2010 Speed Freak team + * @license http://opensource.org/licenses/gpl-license.php GNU Public License + */ + #include "routedialog.h" #include "ui_routedialog.h" +#include "usersettings.h" +#include +#include +#include +#include +#include +#include +#include + +/* + * Vector class. + * In starting Qt 4.6 there is QVector3D. + * Later (updating Qt version) this class can be removed. + */ +class Vector +{ + qreal x, y, z; // Location + qreal v; // Velocity +public: + Vector() { x=0.; y=0. ; z=0.; }; + Vector( qreal initX, qreal initY, qreal initZ) { x = initX, y = initY; z = initZ; }; + void setX( qreal newX) { x = newX; }; + void setY( qreal newY) { y = newY; }; + void setZ( qreal newZ) { z = newZ; }; + void setV( qreal newV) { v = newV; }; + qreal getX() { return x; }; + qreal getY() { return y; }; + qreal getZ() { return z; }; + qreal getV() { return v; }; + qreal length() { return sqrt(x*x+y*y+z*z); }; + Vector operator+(Vector v) + { + x = x + v.x; y = y + v.y; z = z + v.z; + return *this; + }; + Vector operator-(Vector v) + { + x = x - v.x; y = y - v.y; z = z - v.z; + return *this; + }; + Vector operator/(qreal c) + { + x = x/c; y = y/c; z = z/c; + return *this; + }; + Vector crossProduct( Vector a, Vector b) + { + x = a.y*b.z - a.z*b.y; + y = a.z*b.x - a.x*b.z; + z = a.x*b.y - a.y*b.x; + return *this; + }; +}; + + +class Viewing +{ + Vector atPoint, fromPoint, up, a1, a2, a3; + qreal offsx, offsy, offsz; + qreal dval; + qreal angle; +public: + qreal getOffsx() { return offsx; }; + qreal getOffsy() { return offsy; }; + qreal getOffsz() { return offsz; }; + qreal getDval() { return dval; }; + void setAngle( qreal newA) { angle = newA; }; + void setUp( qreal newUpX, qreal newUpY, qreal newUpZ) + { + up.setX(newUpX); up.setY(newUpY); up.setZ(newUpZ); + }; + void setAtPoint( qreal newX, qreal newY, qreal newZ) + { + atPoint.setX(newX); atPoint.setY(newY); atPoint.setZ(newZ); + }; + void setFromPoint(qreal newX, qreal newY, qreal newZ) + { + fromPoint.setX(newX); fromPoint.setY(newY); fromPoint.setZ(newZ); + } + 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); + } ; + Vector getAtPoint() { return atPoint; }; + Vector getFromPoint() { return fromPoint; }; + Vector getA1() { return a1; }; + Vector getA2() { return a2; }; + Vector getA3() { return a3; }; + Viewing () {}; +}; + +qreal xmax, xmin, ymin, ymax; // Limits in world coordinates + +QList vertexList; // Vertecies of route + +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 // For 3d viewing only +qreal a, b,c,d; // Used for 3d viewing to calculate screen coordinates + +Viewing view3d; // Viewing settings for 3d + +// Function prototypes +void dataMinMax( void); +void setAtPoint( Viewing *v); +void setFromPoint( Viewing *v); +void transformseg( Viewing *v, Vector *v1, Vector *v2, int *xscreen1, int *yscreen1, int *xscreen2, int *yscreen2 ); + +#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; + + 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), ui(new Ui::RouteDialog) { ui->setupUi(this); + this->setWindowTitle("Route"); + left = 5; top = 5; right = 495; bottom = 295; // Limits in screen coordinates + + // Send rout to server button disable/enable. + ui->sendPushButton->setEnabled(false); + if (loginSaved()) + { + ui->sendPushButton->setEnabled(true); + } } RouteDialog::~RouteDialog() @@ -24,8 +195,498 @@ void RouteDialog::changeEvent(QEvent *e) break; } } +int RouteDialog::getLeft() +{ + return left; +} +int RouteDialog::getRight() +{ + return right; +} +int RouteDialog::getTop() +{ + return top; +} +int RouteDialog::getBottom() +{ + return bottom; +} + +void drawFlag( RouteDialog *rD, QPainter *p, int x, int y) +{ + /*QPolygon pg; + + pg.setPoint(0,x, y-25); + pg.setPoint(1,x+10,y-20); + pg.setPoint(2,x, y-15); + pg.setPoint(3,x,y-20);*/ + if (y> (rD->getTop() + 25)) + { + // Upside + p->drawLine(x,y,x,y-15); + if (x <= (rD->getRight()-20)) + { + // flag right + p->drawLine( x, y-25, x+10, y-20); + p->drawLine( x+10, y-20, x, y-15); + p->drawLine( x, y-15, x, y-25); + } + else + { + // Flag left + p->drawLine( x, y-25, x-10, y-20); + p->drawLine( x-10, y-20, x, y-15); + p->drawLine( x, y-15, x, y-25); + } + + } + else if (y <= (rD->getTop() + 25)) + { + // downside + p->drawLine(x,y,x,y+15); + if (x <= (rD->getRight()-20)) + { + // flag right + p->drawLine( x, y+25, x+10, y+20); + p->drawLine( x+10, y+20, x, y+15); + p->drawLine( x, y+15, x, y+25); + } + else + { + // Flag left + p->drawLine( x, y+25, x-10, y+20); + p->drawLine( x-10, y+20, x, y+15); + p->drawLine( x, y+15, x, y+25); + } + } + //p->drawPolygon(); + // p->drawPolygon( pg,Qt::OddEvenFill); + //p->drawPolyline( &pg); + //p->drawPoints( pg); +} + +/** + * Draws route to the route dialog. + * Type 0 is 2d viewing and type 1 is for 3d viewing + * @param QPaintEvent + */ +/* */ +void RouteDialog::paintEvent(QPaintEvent *) +{ + 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 x1Screen, y1Screen, x2Screen, y2Screen; + Vector v1, v2; + QPainter painter(this); + + painter.setRenderHint(QPainter::Antialiasing, true); + painter.setPen(QPen((Qt::white),2)); + painter.setBrush(QBrush((Qt::yellow), Qt::SolidPattern)); + + // Draw route window frame + /*painter.drawLine(left,top,right,top); + painter.drawLine(right,top,right,bottom); + painter.drawLine(left,top,left,bottom); + painter.drawLine(left,bottom,right,bottom);*/ + + maxi = vertexList.size(); + + for (i=0; i maxv) + { + maxv = v.getV(); + maxvx = v.getX(); + maxvy = v.getY(); + } + } + // Translate world coordinates to screen coordinates + x1Screen = left + (maxvx-xmin)/(xmax-xmin)*(right-left); + y1Screen = top + (ymax-maxvy)/(ymax-ymin)*(bottom-top); + + // Show max velocity point by yellow circle + painter.drawEllipse( x1Screen-5, y1Screen-5, 10, 10); + + QString jono; + jono = QString("%1 m/s").arg(maxv); + ui->speedValueLabel->setText(jono); + } +} + +bool RouteDialog::readRouteFromFile( QString &routeFile) + { + Vector temp; + QString rivi; + QFile file; + + QString fileName = QFileDialog::getOpenFileName(this, + tr("Read Route"), "./", tr("Route Files (*.txt)")); + + file.setFileName( fileName); + if (!file.open(QIODevice::ReadOnly)) + { + QMessageBox::about(0, "Error", "File not found"); + return false; + } + + vertexList.clear(); + while(!file.atEnd()) + { + QString str1, str2, str3, str4; + rivi = file.readLine(); + + str1 = rivi.section(" ", 0, 0); + if (str1.compare("Start:") != 0 && str1.compare("Stop:") != 0) + { + str1 = rivi.section(" ", 2, 2); // latitude y-value + str2 = rivi.section(" ", 4, 4); // longitude x-value + str3 = rivi.section(" ", 6, 6); // altitude z-value + str4 = rivi.section(" ", 8, 8); // speed m/s + //QString str = QString("la: %1 lo: %2 al: %3").arg(str1).arg(str2).arg(str3); + //QMessageBox::about(0, "LUKEE", str); + + if (str1.length() > 0) + { + double x, y, z, v; + x = str2.toDouble(); + y = str1.toDouble(); + z = str3.toDouble(); + v = str4.toDouble(); + temp.setX( x); // Longitude + temp.setY( y); // Latitude + temp.setZ( z); // altitude + temp.setV( v); + + vertexList.append(temp); + } + } + } + + file.close(); + + /******** in 3d use only */ + a = 400/2.; + b = 1 - a*(-1); + c = -300/2.; + d = 300 - c*(-1); + //angle = toradians(60); + + view3d.setUp( 1.0, 0.0, 0.0); + view3d.setAngle(toradians(60)); + setAtPoint( &view3d); + 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; + } + +/* + * Find out data range for x-, y- and z-coordinates + */ +void dataMinMax( void) +{ + int i, maxi; + qreal x,y,z; + Vector temp; + + temp = vertexList.at(0); + objxmax = objxmin = temp.getX(); + objymax = objymin = temp.getY(); + objzmax = objzmin = temp.getZ(); + + maxi = vertexList.size(); + for (i=1; i objxmax) + { + objxmax = x; + } + + if (y < objymin) + { + objymin = y; + } + else if (y > objymax) + { + objymax = y; + } + + if (z < objzmin) + { + objzmin = z; + } + else if (z > objzmax) + { + objzmax = z; + } + } + //QString jono = QString("ojxmin %1 objxmax %2").arg(objxmin).arg(objxmax); + //QString jono = QString("ojymin %1 objymax %2").arg(objymin).arg(objymax); + //QString jono = QString("ojzmin %1 objzmax %2").arg(objzmin).arg(objzmax); + //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; + + 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); + + /* * + test = v->getAtPoint(); + QString jono = QString("AtX %1 Aty %2 AtZ %3").arg(test.getX()).arg(test.getY()).arg(test.getZ()); + QMessageBox::about(0,"At point", jono); + * */ +} + +/* + * 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; + //fromPoint.setX( atPoint.getX() + (objxmax-objxmin)/2.0 + WIDTH*maxof((objzmax-objzmin)/2.0,(objymax-objymin)/2.0)); + //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); + /* * + test = v->getFromPoint(); + QString jono = QString("FromX %1 FromY %2 FromZ %3").arg(test.getX()).arg(test.getY()).arg(test.getZ()); + QMessageBox::about(0,"From point", jono); // (1.9, 0.5, 0.5) + * */ +} + + +#define NOEDGE 0x00 +#define LEFTEDGE 0x01 +#define RIGHTEDGE 0x02 +#define BOTTOMEDGE 0x04 +#define TOPEDGE 0x08 +/* + * Returns a code specifying which edge in the viewing pyramid was crossed. + * There may be more than one. + */ +int code( qreal x, qreal y, qreal z) +{ + int c; + + c = NOEDGE; + if (x<-z) c |= LEFTEDGE; + if (x>z) c |= RIGHTEDGE; + if (y<-z) c |= BOTTOMEDGE; + if (y>z) c |= TOPEDGE; + + return c; +} + +/* + * Converts clipped world coordinates to screen coordinates. + */ +void WORLDtoSCREEN( qreal xWorld, qreal yWorld, int *xScreen, int *yScreen) +{ + *xScreen = (int) (a*xWorld+b); + *yScreen = (int) (c*yWorld+d); +} + +/* + * Clips the line segment in three-dimensional coordinates to the + * viewing pyramid. + */ +void clip3d( qreal x1, qreal y1, qreal z1, qreal x2, qreal y2, qreal z2, int *xscreen1, int *yscreen1, int *xscreen2, int *yscreen2) +{ + int c,c1,c2; + qreal x,y,z,t; + + c1 = code(x1,y1,z1); + c2 = code(x2,y2,z2); + + while (c1!= NOEDGE || c2 != NOEDGE) + { + if ((c1 & c2 ) != NOEDGE) return; + c = c1; + if (c == NOEDGE) c = c2; + if ((c&LEFTEDGE) == LEFTEDGE) + { + // Crosses left edge + t = (z1+x1)/((x1-x2)-(z2-z1)); + z = t*(z2-z1)+z1; + x = -z; + y = t*(y2-y1)+y1; + } + else if ((c&RIGHTEDGE) == RIGHTEDGE) + { + // Crosses right edge + t = (z1-x1)/((x2-x1)-(z2-z1)); + z = t*(z2-z1)+z1; + x = z; + y = t*(y2-y1)+y1; + } + else if ((c&BOTTOMEDGE) == BOTTOMEDGE) + { + // Crosses bottom edge + t = (z1+y1)/((y1-y2)-(z2-z1)); + z = t*(z2-z1)+z1; + x = t*(x2-x1)+x1; + y = -z; + } + else if ((c&TOPEDGE) == TOPEDGE) + { + // Crosses top edge + t = (z1-y1)/((y2-y1)-(z2-z1)); + z = t*(z2-z1)+z1; + x = t*(x2-x1)+x1; + y = z; + } + + if (c == c1) + { + x1=x; y1=y; z1=z; + c1 = code(x,y,z); + } + else + { + x2=x; y2=y; z2=z; + c2 = code(x,y,z); + } + } + + if (z1 != 0) + { + WORLDtoSCREEN(x1/z1,y1/z1,xscreen1, yscreen1); + WORLDtoSCREEN(x2/z2,y2/z2,xscreen2, yscreen2); + } + else + { + WORLDtoSCREEN(x1,y1,xscreen1, yscreen1); + WORLDtoSCREEN(x2,y2,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) + +{ + qreal x1, y1, z1, x2, y2, z2; + Vector a1, a2, a3; + + a1 = v->getA1(); + a2 = v->getA2(); + a3 = v->getA3(); + + 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() + 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 ); +} + +void RouteDialog::on_newPushButton_clicked() +{ + close(); // go back to previous dialog +} -void RouteDialog::on_closePushButton_clicked() +void RouteDialog::on_sendPushButton_clicked() { - close(); + // Send route points file to server }