QGC 谷歌中国地图 火星坐标系 转换
1，算法
static double pi = 3.1415926535897932384626;static double a = 6378245.0;static double ee = 0.00669342162296594323;//坐标系转换 static double lonTrans(double x,double y); static double latTrans(double x,double y); static bool outOfChina(double lat,double lng); static void wgs84ToGcj02(double wgs_lat, double wgs_lon,double &gcjLat,double &gcjLon);static void gcj02ToWgs84(double gcjLat,double gcjLon,double &wgs_lat, double &wgs_lon);
double Vehicle::lonTrans(double x, double y){ double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1 * sqrt(abs(x)); ret += (20.0 * sin(6.0 * x * pi) + 20.0 * sin(2.0 * x * pi)) * 2.0 / 3.0; ret += (20.0 * sin(x * pi) + 40.0 * sin(x / 3.0 * pi)) * 2.0 / 3.0; ret += (150.0 * sin(x / 12.0 * pi) + 300.0 * sin(x / 30.0 * pi)) * 2.0 / 3.0; return ret;}
double Vehicle::latTrans(double x, double y){ double ret =-100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y + 0.2 * sqrt(abs(x)); ret += (20.0 * sin(6.0 * x * pi) + 20.0 * sin(2.0 * x * pi)) * 2.0 / 3.0; ret += (20.0 * sin(y * pi) + 40.0 * sin(y / 3.0 * pi)) * 2.0 / 3.0; ret += (160.0 * sin(y / 12.0 * pi) + 320 * sin(y * pi / 30.0)) * 2.0 / 3.0; return ret;}
bool Vehicle::outOfChina(double lat,double lng){ if (lng < 72.004 || lng > 137.8347) { return true; } else if (lat < 0.8293 || lat > 55.8271) { return true; } return false;}
void Vehicle::wgs84ToGcj02(double wgs_lat, double wgs_lon,double &gcjLat,double &gcjLon){ if(!outOfChina(wgs_lat,wgs_lon)) { double dLat = latTrans(wgs_lon - 105.0, wgs_lat - 35.0); double dLon = lonTrans(wgs_lon - 105.0, wgs_lat - 35.0); double radLat = wgs_lat / 180.0 * pi; double magic = sin(radLat); magic = 1 - ee * magic * magic; double sqrtMagic = sqrt(magic); dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi); dLon = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * pi); gcjLat = wgs_lat + dLat; gcjLon = wgs_lon + dLon; }else{ gcjLat=wgs_lat; gcjLon = wgs_lon; }}
void Vehicle::gcj02ToWgs84(double gcjLat, double gcjLon, double &wgs_lat, double &wgs_lon){ if(!outOfChina(gcjLat,gcjLon)) { double dLat = latTrans(gcjLon - 105.0, gcjLat - 35.0); double dLon = lonTrans(gcjLon - 105.0, gcjLat - 35.0); double radLat = gcjLat / 180.0 * pi; double magic = sin(radLat); magic = 1 - ee * magic * magic; double sqrtMagic = sqrt(magic); dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi); dLon = (dLon * 180.0) / (a / sqrtMagic * cos(radLat) * pi); double tempLat = gcjLat + dLat; double tempLon = gcjLon + dLon;
wgs_lat = gcjLat*2-tempLat; wgs_lon = gcjLon*2-tempLon; }else{ wgs_lat = gcjLat; wgs_lon = gcjLon; }}2，四个 地方需要添加转换
（1），飞机位置
//设置飞机的 位置 wgs84->火星坐标系void Vehicle::setLatitude(double latitude){ _coordinate.setLatitude(latitude);
//坐标转换 double gcjLat=0,gcjLon=0; wgs84ToGcj02(_coordinate.latitude(),_coordinate.longitude(),gcjLat,gcjLon); _coordinate.setLatitude(gcjLat);
emit coordinateChanged(_coordinate);}
void Vehicle::setLongitude(double longitude){ _coordinate.setLongitude(longitude);
//坐标转换 double gcjLat=0,gcjLon=0; wgs84ToGcj02(_coordinate.latitude(),_coordinate.longitude(),gcjLat,gcjLon); _coordinate.setLongitude(gcjLon);
emit coordinateChanged(_coordinate);}（2），上传任务时
void MissionManager::_handleMissionItem(const mavlink_message_t& message){ mavlink_mission_item_t missionItem; if (!_checkForExpectedAck(AckMissionItem)) { return; } mavlink_msg_mission_item_decode(&message, &missionItem); qCDebug(MissionManagerLog) << "_handleMissionItem sequenceNumber:" << missionItem.seq<<"->> "<<missionItem.x<<" "<<missionItem.y; if (_itemIndicesToRead.contains(missionItem.seq)) { _itemIndicesToRead.removeOne(missionItem.seq); //wgs84->火星坐标系 double gcjLat=0,gcjLon=0; Vehicle::wgs84ToGcj02(missionItem.x,missionItem.y,gcjLat,gcjLon); qDebug()<<"wgs84->gcj"<<missionItem.x<<missionItem.y<<" "<<gcjLat<<gcjLon; /********************************************/
MissionItem* item = new MissionItem(missionItem.seq, (MAV_CMD)missionItem.command, (MAV_FRAME)missionItem.frame, missionItem.param1, missionItem.param2, missionItem.param3, missionItem.param4, gcjLat/*missionItem.x*/, gcjLon/*missionItem.y*/, missionItem.z, missionItem.autocontinue, missionItem.current, this);
if (item->command() == MAV_CMD_DO_JUMP && !_vehicle->firmwarePlugin()->sendHomePositionToVehicle()) { // Home is in position 0 item->setParam1((int)item->param1() + 1); }
_missionItems.append(item); } else { qCDebug(MissionManagerLog) << "_handleMissionItem mission item received item index which was not requested, disregrarding:" << missionItem.seq; // We have to put the ack timeout back since it was removed above _startAckTimeout(AckMissionItem); return; } _retryCount = 0; if (_itemIndicesToRead.count() == 0) { _readTransactionComplete(); } else { _requestNextMissionItem(); }}（3），下载任务时
void MissionManager::_handleMissionRequest(const mavlink_message_t& message){ mavlink_mission_request_t missionRequest; if (!_checkForExpectedAck(AckMissionRequest)) { return; } mavlink_msg_mission_request_decode(&message, &missionRequest); qCDebug(MissionManagerLog) << "_handleMissionRequest sequenceNumber:" << missionRequest.seq; if (!_itemIndicesToWrite.contains(missionRequest.seq)) { if (missionRequest.seq > _missionItems.count()) { _sendError(RequestRangeError, QString("Vehicle requested item outside range, count:request %1:%2. Send to Vehicle failed.").arg(_missionItems.count()).arg(missionRequest.seq)); _finishTransaction(false); return; } else { qCDebug(MissionManagerLog) << "_handleMissionRequest sequence number requested which has already been sent, sending again:" << missionRequest.seq; } } else { _itemIndicesToWrite.removeOne(missionRequest.seq); } mavlink_message_t messageOut; mavlink_mission_item_t missionItem; MissionItem* item = _missionItems[missionRequest.seq]; //火星 坐标 ->WGS84 double gcjLat= item->param5(); double gcjLon = item->param6(); double wgsLat=0; double wgsLon=0;
Vehicle::gcj02ToWgs84(gcjLat,gcjLon,wgsLat,wgsLon); qDebug()<<"gcj->wgs84"<<gcjLat<<gcjLon<<" "<<wgsLat<<wgsLon; /***********************************/
missionItem.target_system = _vehicle->id(); missionItem.target_component = MAV_COMP_ID_MISSIONPLANNER; missionItem.seq = missionRequest.seq; missionItem.command = item->command(); missionItem.param1 = item->param1(); missionItem.param2 = item->param2(); missionItem.param3 = item->param3(); missionItem.param4 = item->param4(); missionItem.x = wgsLat;//item->param5(); missionItem.y = wgsLon;//item->param6(); missionItem.z = item->param7(); missionItem.frame = item->frame(); missionItem.current = missionRequest.seq == 0; missionItem.autocontinue = item->autoContinue(); mavlink_msg_mission_item_encode_chan(qgcApp()->toolbox()->mavlinkProtocol()->getSystemId(), qgcApp()->toolbox()->mavlinkProtocol()->getComponentId(), _dedicatedLink->mavlinkChannel(), &messageOut, &missionItem);
_vehicle->sendMessageOnLink(_dedicatedLink, messageOut); _startAckTimeout(AckMissionRequest);}（4），飞行界面 home点
void Vehicle::_handleHomePosition(mavlink_message_t& message)
{
bool emitHomePositionChanged = false;
bool emitHomePositionAvailableChanged = false;
mavlink_home_position_t homePos;
mavlink_msg_home_position_decode(&message, &homePos);
//坐标转换
double gcjLat=0,gcjLon=0;
wgs84ToGcj02(homePos.latitude / 10000000.0, homePos.longitude / 10000000.0,gcjLat,gcjLon);
QGeoCoordinate newHomePosition (gcjLat, gcjLon, homePos.altitude / 1000.0);
/*********************************************************************************/
// QGeoCoordinate newHomePosition (homePos.latitude / 10000000.0,
// homePos.longitude / 10000000.0,
// homePos.altitude / 1000.0);
if (!_homePositionAvailable || newHomePosition != _homePosition) {
emitHomePositionChanged = true;
_homePosition = newHomePosition;
}
if (!_homePositionAvailable) {
emitHomePositionAvailableChanged = true;
_homePositionAvailable = true;
}
if (emitHomePositionChanged) {
qCDebug(VehicleLog) << "New home position" << newHomePosition;
qgcApp()->setLastKnownHomePosition(_homePosition);
emit homePositionChanged(_homePosition);
}
if (emitHomePositionAvailableChanged) {
emit homePositionAvailableChanged(true);
}
}
关注微信，以免错过更多精彩内容：
QGC 谷歌中国地图 火星坐标系 转换相关推荐
- pol点获取及火星坐标系转换
打开规划云http://guihuayun.com/poi/搜索pol兴趣点并复制兴趣点, 新建txt文本文档,粘贴兴趣点 查看后得知,lng为横坐标,lat为纵坐标 文件,另存为csv格式文件, ...
- echarts 绘制中国地图（中英文转换）
echarts 绘制中国地图 1.引入echarts npm install echarts import echarts from 'echarts' 2.引入地图china.js(网上自行搜索下载 ...
- 友盟创始人蒋凡---谷歌中国地图工程师
友盟创始人蒋凡:李开复招牌成吸纳人才法宝 腾讯科技徐志斌 雷建平 [导读]作为创新工厂孵化的项目,蒋凡坦言获得了创新工厂很大帮助,包括团队组建.市场合作,团队还可以借助创新工场李开复这个品牌吸引更多人 ...
- QGC增加 google中国地图
效果: 1,设置 选择框,增加 googleChina 选项 2,添加 类型 3,增加 google 瓦片 获取地址 注意事项: (1),QGC 的地图采用 瓦片拼接的形式,原理如下:http://w ...
- WGS84地球坐标系，GCJ02火星坐标系，BD09百度坐标系简介与转换，mybatis字段映射原理
1.各坐标系简介 2.各坐标系转换 2.1坐标点实体类 2.2各坐标系转换工具类 3.测试 1.各坐标系简介 WGS84坐标系 即地球坐标系,国际上通用的坐标系. 设备一般包含GPS芯片或者北斗芯片获 ...
- 各种经纬度坐标系转换-百度坐标系、火星坐标系、国际坐标系
各种经纬度坐标系转换-百度坐标系.火星坐标系.国际坐标系 (文章代码参考网上 测试没什么问题, 汇总整理希望对大家有帮助-dou )WGS84:国际坐标系,为一种大地坐标系,也是目前广泛使用的GPS全 ...
- python地图坐标系转换(bd09,gcj02,wgs84三种投影坐标系相互转化)
1.介绍 1.1 GIS之坐标系 坐标系是GIS的重中之重,一般来说,工作底图平面坐标系应采用国家大地坐标系CGCS2000(或相当于精度WGS84坐标系),投影方式采用高斯-克吕格投影,高程基准采用 ...
- wgs-84,gcj-02,bd-09的相互转换，高德，世界测量，百度坐标系的相互转换，坐标系转换
高德使用的是gcj-02坐标系,百度使用的是bd09坐标系,注意其间的相互转换 1.首先创建一个GPS对象类 public class Gps {private double wgLat;privat ...
- 坐标计算距离公式 火星坐标系_根据经纬度计算距离的公式、百度坐标转换成GPS坐标(PHP版)...
//百度坐标转换成GPS坐标 $lnglat = '121.437518,31.224665'; function FromBaiduToGpsXY($lnglat){ // 经度,纬度 $lngla ...
- 对互联网中常见地图的坐标系探讨
文章版权由作者李晓晖和博客园共有,若转载请于明显处标明出处:http://www.cnblogs.com/naaoveGIS/. 1.背景 目前项目中使用百度地图.高德地图.谷歌中国地图.天地图的需求 ...
最新文章
- java实现一个跳转结构程序,Java程序设计基础（第6版）最新章节_鲜征征著_得间小说...
- Tomcat启动时卡在org.apache.catalina.startup.HostConfig
- Eclipse中Build Path的使用介绍---学习笔记
- docker 部署nginx 使用keepalived 部署高可用
- 4线电子围栏安装示意图_电子围栏报警系统安装施工过程（图解）
- 专访Google数据科学家彭晨：大数据成为潮流走近各行各业！
- Swift使用CoreLocation，你必须要看这一篇
- 【动态规划】计蒜客：跳木桩（最长递增子序列的变体）
- 配置eclipse插件
- java sqlserver数据库连接_JAVA连接SQLserver数据库
- cesium加载shp格式数据
- 怎么成为一名Java架构师 都需要掌握哪些技术
- 最新，87本SCI/SSCI期刊被剔除，这5本TOP刊也在内？
- 用CST进行多物理仿真，热仿真结果有误
- linux indent添加,linux indent格式化代码
- 使用jmeter进行api接口压力测试
- Python正则表达式 re
- [R语言]R包的安装帮助获取
- codeblocks编译出错问题的解答！（编译c++ 或者c程序）
- 任何物体都在以光速运动，你能理解这一认识吗？