82 |
cairo_surface_t *surface; |
cairo_surface_t *surface; |
83 |
float lat, lon; |
float lat, lon; |
84 |
char *name; |
char *name; |
85 |
|
gboolean imperial; // display distance imperial/metric |
86 |
} nav; |
} nav; |
87 |
#endif |
#endif |
88 |
|
|
1210 |
|
|
1211 |
#ifdef OSD_NAV |
#ifdef OSD_NAV |
1212 |
#define OSD_NAV_W (8*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET) |
#define OSD_NAV_W (8*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET) |
1213 |
#define OSD_NAV_H (150) |
#define OSD_NAV_H (11*OSD_COORDINATES_FONT_SIZE) |
1214 |
|
|
1215 |
|
/* http://mathforum.org/library/drmath/view/55417.html */ |
1216 |
|
static float get_bearing(float lat1, float lon1, float lat2, float lon2) { |
1217 |
|
return atan2( sin(lon2 - lon1) * cos(lat2), |
1218 |
|
cos(lat1) * sin(lat2) - |
1219 |
|
sin(lat1) * cos(lat2) * cos(lon2 - lon1)); |
1220 |
|
} |
1221 |
|
|
1222 |
|
/* http://mathforum.org/library/drmath/view/51722.html */ |
1223 |
|
static float get_distance(float lat1, float lon1, float lat2, float lon2) { |
1224 |
|
float aob = acos(cos(lat1) * cos(lat2) * cos(lon2 - lon1) + |
1225 |
|
sin(lat1) * sin(lat2)); |
1226 |
|
|
1227 |
|
// return(aob * 3959.0); /* great circle radius in miles */ |
1228 |
|
|
1229 |
|
return(aob * 6371000.0); /* great circle radius in meters */ |
1230 |
|
} |
1231 |
|
|
1232 |
static void |
static void |
1233 |
osd_render_nav(osm_gps_map_osd_t *osd) |
osd_render_nav(osm_gps_map_osd_t *osd) |
1240 |
/* first fill with transparency */ |
/* first fill with transparency */ |
1241 |
cairo_t *cr = cairo_create(priv->nav.surface); |
cairo_t *cr = cairo_create(priv->nav.surface); |
1242 |
cairo_set_operator(cr, CAIRO_OPERATOR_SOURCE); |
cairo_set_operator(cr, CAIRO_OPERATOR_SOURCE); |
1243 |
cairo_set_source_rgba(cr, 1.0, 0.0, 0.0, 0.2); |
cairo_set_source_rgba(cr, 1.0, 0.0, 0.0, 0.0); |
1244 |
cairo_paint(cr); |
cairo_paint(cr); |
1245 |
cairo_set_operator(cr, CAIRO_OPERATOR_OVER); |
cairo_set_operator(cr, CAIRO_OPERATOR_OVER); |
1246 |
|
|
1282 |
#define ARROW_WIDTH 0.3 |
#define ARROW_WIDTH 0.3 |
1283 |
#define ARROW_LENGTH 0.7 |
#define ARROW_LENGTH 0.7 |
1284 |
|
|
1285 |
float arot = deg2rad(45); |
coord_t *gps = osm_gps_map_get_gps (OSM_GPS_MAP(osd->widget)); |
1286 |
|
if(gps) { |
1287 |
cairo_move_to(cr, |
float arot = get_bearing(gps->rlat, gps->rlon, |
1288 |
x + radius * ARROW_LENGTH * sin(arot), |
deg2rad(priv->nav.lat), deg2rad(priv->nav.lon)); |
1289 |
y + radius * ARROW_LENGTH * -cos(arot)); |
|
1290 |
|
cairo_move_to(cr, |
1291 |
cairo_line_to(cr, |
x + radius * ARROW_LENGTH * sin(arot), |
1292 |
x + radius * -ARROW_LENGTH * sin(arot+ARROW_WIDTH), |
y + radius * ARROW_LENGTH * -cos(arot)); |
1293 |
y + radius * -ARROW_LENGTH * -cos(arot+ARROW_WIDTH)); |
|
1294 |
|
cairo_line_to(cr, |
1295 |
cairo_line_to(cr, |
x + radius * -ARROW_LENGTH * sin(arot+ARROW_WIDTH), |
1296 |
x + radius * -0.5 * ARROW_LENGTH * sin(arot), |
y + radius * -ARROW_LENGTH * -cos(arot+ARROW_WIDTH)); |
1297 |
y + radius * -0.5 * ARROW_LENGTH * -cos(arot)); |
|
1298 |
|
cairo_line_to(cr, |
1299 |
cairo_line_to(cr, |
x + radius * -0.5 * ARROW_LENGTH * sin(arot), |
1300 |
x + radius * -ARROW_LENGTH * sin(arot-ARROW_WIDTH), |
y + radius * -0.5 * ARROW_LENGTH * -cos(arot)); |
1301 |
y + radius * -ARROW_LENGTH * -cos(arot-ARROW_WIDTH)); |
|
1302 |
|
cairo_line_to(cr, |
1303 |
cairo_close_path(cr); |
x + radius * -ARROW_LENGTH * sin(arot-ARROW_WIDTH), |
1304 |
cairo_set_source_rgb (cr, 0, 0, 0); |
y + radius * -ARROW_LENGTH * -cos(arot-ARROW_WIDTH)); |
1305 |
cairo_fill (cr); |
|
1306 |
|
cairo_close_path(cr); |
1307 |
|
cairo_set_source_rgb (cr, 0, 0, 0); |
1308 |
|
cairo_fill (cr); |
1309 |
|
|
1310 |
|
y += radius + OSD_COORDINATES_FONT_SIZE/4; |
1311 |
|
|
1312 |
|
float dist = get_distance(gps->rlat, gps->rlon, |
1313 |
|
deg2rad(priv->nav.lat), deg2rad(priv->nav.lon)); |
1314 |
|
|
1315 |
|
char *dist_str = NULL; |
1316 |
|
if(!priv->nav.imperial) { |
1317 |
|
/* metric is easy ... */ |
1318 |
|
if(dist<1000) |
1319 |
|
dist_str = g_strdup_printf("%u m", (int)dist); |
1320 |
|
else |
1321 |
|
dist_str = g_strdup_printf("%.1f km", dist/1000); |
1322 |
|
} else { |
1323 |
|
/* and now the hard part: scale for useful imperial values :-( */ |
1324 |
|
/* try to convert to feet, 1ft == 0.3048 m */ |
1325 |
|
|
1326 |
y += radius + OSD_COORDINATES_FONT_SIZE/4; |
if(dist/(3*0.3048) >= 1760.0) /* more than 1760 yard? */ |
1327 |
y = osd_render_centered_text(cr, y, OSD_NAV_W, "xx,xx km"); |
dist_str = g_strdup_printf("%.1f mi", dist/(0.3048*3*1760.0)); |
1328 |
|
else if(dist/0.3048 >= 100) /* more than 100 feet? */ |
1329 |
|
dist_str = g_strdup_printf("%.1f yd", dist/(0.3048*3)); |
1330 |
|
else |
1331 |
|
dist_str = g_strdup_printf("%.0f ft", dist/0.3048); |
1332 |
|
} |
1333 |
|
|
1334 |
|
y = osd_render_centered_text(cr, y, OSD_NAV_W, dist_str); |
1335 |
|
g_free(dist_str); |
1336 |
|
} |
1337 |
|
|
1338 |
cairo_destroy(cr); |
cairo_destroy(cr); |
1339 |
} |
} |
1358 |
} |
} |
1359 |
|
|
1360 |
void |
void |
1361 |
osm_gps_map_osd_draw_nav (OsmGpsMap *map, float latitude, float longitude, |
osm_gps_map_osd_draw_nav (OsmGpsMap *map, gboolean imperial, |
1362 |
char *name) { |
float latitude, float longitude, char *name) { |
1363 |
g_return_if_fail (OSM_IS_GPS_MAP (map)); |
g_return_if_fail (OSM_IS_GPS_MAP (map)); |
1364 |
|
|
1365 |
osm_gps_map_osd_t *osd = osm_gps_map_osd_get(map); |
osm_gps_map_osd_t *osd = osm_gps_map_osd_get(map); |
1378 |
priv->nav.lat = latitude; |
priv->nav.lat = latitude; |
1379 |
priv->nav.lon = longitude; |
priv->nav.lon = longitude; |
1380 |
priv->nav.name = g_strdup(name); |
priv->nav.name = g_strdup(name); |
1381 |
|
priv->nav.imperial = imperial; |
1382 |
|
|
1383 |
osd_render_nav(osd); |
osd_render_nav(osd); |
1384 |
|
|