Qt---关于两个gps位置的角度，距离，及仰角计算

#include "mainwindow.h" #include "ui_mainwindow.h" #include <QtCore/qmath.h> #include <QDebug> MainWindow::MainWindow(QWidget *parent) : QMainWindow(parent), ui(new Ui::MainWindow) { ui->setupUi(this); init(); on_pushButton_calculate_clicked(); } MainWindow::~MainWindow() { delete ui; } void MainWindow::init() { lat1=39.4; lat2=38.4; long1=116.4; long2=116.4; alt1=0; alt2=500; azangle=0; elangle=0; distance=0; ui->lineEdit_lat1->setText("39.4"); ui->lineEdit_lat2->setText("38.4"); ui->lineEdit_long1->setText("116.4"); ui->lineEdit_long2->setText("116.4"); ui->lineEdit_alt1->setText("0"); ui->lineEdit_alt2->setText("5000"); ui->lineEdit_azangle->setText("0"); ui->lineEdit_distance->setText("0"); ui->lineEdit_elangle->setText("0"); } double MainWindow::getdistance(double lat_a, double lat_b, double long_a, double long_b) { double a,b,R,d; R=6378137; a=qSin((lat_b-lat_a)*M_PI/360.0); b=qSin((long_b-long_a)*M_PI/360.0); d=2*R*asin(qSqrt(a*a+qCos(lat_a*M_PI/180.0)*qCos(lat_b*M_PI/180.0)*b*b)); return d; } double MainWindow::getazangle(double lat_a, double lat_b, double long_a, double long_b) { double y=qSin(long_b-long_a)*qCos(lat_b); double x=qCos(lat_a)*qSin(lat_b)-qSin(lat_a)*qCos(lat_b)*qCos(long_b-long_a); double brng=qAtan2(y,x); brng = brng*180.0/M_PI; if(brng<0) brng=brng+360.0; return brng; } double MainWindow::getelangle(double lat_a, double lat_b, double long_a, double long_b, double alt_a, double alt_b) { distance=getdistance(lat_a,lat_b,long_a,long_b); elangle=qAtan2((alt_b-alt_a),distance)*180.0/M_PI; // qDebug()<<"elangle"<<elangle<<endl; return elangle; } void MainWindow::on_pushButton_calculate_clicked() { long1=ui->lineEdit_long1->text().toDouble(); long2=ui->lineEdit_long2->text().toDouble(); lat1=ui->lineEdit_lat1->text().toDouble(); lat2=ui->lineEdit_lat2->text().toDouble(); alt1=ui->lineEdit_alt1->text().toDouble(); alt2=ui->lineEdit_alt2->text().toDouble(); distance=getdistance(lat1,lat2,long1,long2); QString s_distance=QString::number(distance,'g',10); ui->lineEdit_distance->setText(s_distance); elangle=getelangle(lat1,lat2,long1,long2,alt1,alt2); QString s_elangle=QString::number(elangle,'g',10); ui->lineEdit_elangle->setText(s_elangle); azangle=getazangle(lat1,lat2,long1,long2); QString s_azangle=QString::number(azangle,'g',10); ui->lineEdit_azangle->setText(s_azangle); }