19 |
|
|
20 |
#include "config.h" |
#include "config.h" |
21 |
#include <stdlib.h> // abs |
#include <stdlib.h> // abs |
22 |
|
#include <string.h> |
23 |
#include <math.h> // M_PI/cos() |
#include <math.h> // M_PI/cos() |
24 |
|
|
25 |
/* parameters that can be overwritten from the config file: */ |
/* parameters that can be overwritten from the config file: */ |
26 |
/* OSD_DIAMETER */ |
/* OSD_DIAMETER */ |
27 |
/* OSD_X, OSD_Y */ |
/* OSD_X, OSD_Y */ |
28 |
|
|
|
#define OSD_NAV |
|
|
|
|
29 |
#ifndef USE_CAIRO |
#ifndef USE_CAIRO |
30 |
#error "OSD control display lacks a non-cairo implementation!" |
#error "OSD control display lacks a non-cairo implementation!" |
31 |
#endif |
#endif |
80 |
#ifdef OSD_NAV |
#ifdef OSD_NAV |
81 |
struct { |
struct { |
82 |
cairo_surface_t *surface; |
cairo_surface_t *surface; |
83 |
|
float lat, lon; |
84 |
|
char *name; |
85 |
} nav; |
} nav; |
86 |
#endif |
#endif |
87 |
|
|
1072 |
#define OSD_COORDINATES_OFFSET (OSD_COORDINATES_FONT_SIZE/6) |
#define OSD_COORDINATES_OFFSET (OSD_COORDINATES_FONT_SIZE/6) |
1073 |
|
|
1074 |
#define OSD_COORDINATES_W (8*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET) |
#define OSD_COORDINATES_W (8*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET) |
1075 |
#define OSD_COORDINATES_H (2*OSD_COORDINATES_FONT_SIZE+OSD_COORDINATES_OFFSET) |
#define OSD_COORDINATES_H (2*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET+OSD_COORDINATES_FONT_SIZE/4) |
1076 |
|
|
1077 |
/* these can be overwritten with versions that support */ |
/* these can be overwritten with versions that support */ |
1078 |
/* localization */ |
/* localization */ |
1130 |
c, (int)integral, fractional*60.0); |
c, (int)integral, fractional*60.0); |
1131 |
} |
} |
1132 |
|
|
1133 |
|
/* render a string at the given screen position */ |
1134 |
|
static int |
1135 |
|
osd_render_centered_text(cairo_t *cr, int y, int width, char *text) { |
1136 |
|
char *p = g_strdup(text); |
1137 |
|
cairo_text_extents_t extents; |
1138 |
|
cairo_text_extents (cr, p, &extents); |
1139 |
|
|
1140 |
|
/* check if text needs to be truncated */ |
1141 |
|
int len = strlen(text)-2; |
1142 |
|
while(extents.width > width) { |
1143 |
|
len--; |
1144 |
|
strcpy(p+len, "..."); |
1145 |
|
cairo_text_extents (cr, p, &extents); |
1146 |
|
} |
1147 |
|
|
1148 |
|
cairo_set_source_rgb(cr, 1.0, 1.0, 1.0); |
1149 |
|
cairo_set_line_width (cr, OSD_COORDINATES_FONT_SIZE/6); |
1150 |
|
cairo_move_to (cr, (width - extents.width)/2, y - extents.y_bearing); |
1151 |
|
cairo_text_path (cr, p); |
1152 |
|
cairo_stroke (cr); |
1153 |
|
|
1154 |
|
cairo_set_source_rgb(cr, 0.0, 0.0, 0.0); |
1155 |
|
cairo_move_to (cr, (width - extents.width)/2, y - extents.y_bearing); |
1156 |
|
cairo_show_text (cr, p); |
1157 |
|
|
1158 |
|
g_free(p); |
1159 |
|
|
1160 |
|
/* skip + 1/4 line */ |
1161 |
|
return y + 5*OSD_COORDINATES_FONT_SIZE/4; |
1162 |
|
} |
1163 |
|
|
1164 |
static void |
static void |
1165 |
osd_render_coordinates(osm_gps_map_osd_t *osd) |
osd_render_coordinates(osm_gps_map_osd_t *osd) |
1166 |
{ |
{ |
1196 |
char *latitude = osd_latitude_str(lat); |
char *latitude = osd_latitude_str(lat); |
1197 |
char *longitude = osd_longitude_str(lon); |
char *longitude = osd_longitude_str(lon); |
1198 |
|
|
1199 |
cairo_text_extents_t lat_extents, lon_extents; |
int y = OSD_COORDINATES_OFFSET; |
1200 |
cairo_text_extents (cr, latitude, &lat_extents); |
y = osd_render_centered_text(cr, y, OSD_COORDINATES_W, latitude); |
1201 |
cairo_text_extents (cr, longitude, &lon_extents); |
y = osd_render_centered_text(cr, y, OSD_COORDINATES_W, longitude); |
1202 |
|
|
|
cairo_set_source_rgb(cr, 1.0, 1.0, 1.0); |
|
|
cairo_set_line_width (cr, OSD_COORDINATES_FONT_SIZE/6); |
|
|
cairo_move_to (cr, |
|
|
(OSD_COORDINATES_W - lat_extents.width)/2, |
|
|
OSD_COORDINATES_OFFSET - lat_extents.y_bearing); |
|
|
cairo_text_path (cr, latitude); |
|
|
cairo_move_to (cr, |
|
|
(OSD_COORDINATES_W - lon_extents.width)/2, |
|
|
OSD_COORDINATES_OFFSET - lon_extents.y_bearing + |
|
|
OSD_COORDINATES_FONT_SIZE); |
|
|
cairo_text_path (cr, longitude); |
|
|
cairo_stroke (cr); |
|
|
|
|
|
cairo_set_source_rgb(cr, 0.0, 0.0, 0.0); |
|
|
cairo_move_to (cr, |
|
|
(OSD_COORDINATES_W - lat_extents.width)/2, |
|
|
OSD_COORDINATES_OFFSET - lat_extents.y_bearing); |
|
|
cairo_show_text (cr, latitude); |
|
|
cairo_move_to (cr, |
|
|
(OSD_COORDINATES_W - lon_extents.width)/2, |
|
|
OSD_COORDINATES_OFFSET - lon_extents.y_bearing + |
|
|
OSD_COORDINATES_FONT_SIZE); |
|
|
cairo_show_text (cr, longitude); |
|
|
|
|
1203 |
g_free(latitude); |
g_free(latitude); |
1204 |
g_free(longitude); |
g_free(longitude); |
1205 |
|
|
1208 |
#endif // OSD_COORDINATES |
#endif // OSD_COORDINATES |
1209 |
|
|
1210 |
#ifdef OSD_NAV |
#ifdef OSD_NAV |
1211 |
#define OSD_NAV_W (100) |
#define OSD_NAV_W (8*OSD_COORDINATES_FONT_SIZE+2*OSD_COORDINATES_OFFSET) |
1212 |
#define OSD_NAV_H (100) |
#define OSD_NAV_H (130) |
1213 |
|
|
1214 |
|
/* http://mathforum.org/library/drmath/view/55417.html */ |
1215 |
|
static float get_bearing(float lat1, float lon1, float lat2, float lon2) { |
1216 |
|
return atan2( sin(lon2 - lon1) * cos(lat2), |
1217 |
|
cos(lat1) * sin(lat2) - |
1218 |
|
sin(lat1) * cos(lat2) * cos(lon2 - lon1)); |
1219 |
|
} |
1220 |
|
|
1221 |
|
/* http://mathforum.org/library/drmath/view/51722.html */ |
1222 |
|
static float get_distance(float lat1, float lon1, float lat2, float lon2) { |
1223 |
|
float aob = acos(cos(lat1) * cos(lat2) * cos(lon2 - lon1) + |
1224 |
|
sin(lat1) * sin(lat2)); |
1225 |
|
|
1226 |
|
// return(aob * 3959.0); /* great circle radius in miles */ |
1227 |
|
|
1228 |
|
return(aob * 6371000.0); /* great circle radius in meters */ |
1229 |
|
} |
1230 |
|
|
1231 |
static void |
static void |
1232 |
osd_render_nav(osm_gps_map_osd_t *osd) |
osd_render_nav(osm_gps_map_osd_t *osd) |
1233 |
{ |
{ |
1234 |
osd_priv_t *priv = (osd_priv_t*)osd->priv; |
osd_priv_t *priv = (osd_priv_t*)osd->priv; |
1235 |
|
|
1236 |
|
if(!priv->nav.surface || isnan(priv->nav.lat) || isnan(priv->nav.lon)) |
1237 |
|
return; |
1238 |
|
|
1239 |
/* first fill with transparency */ |
/* first fill with transparency */ |
1240 |
cairo_t *cr = cairo_create(priv->nav.surface); |
cairo_t *cr = cairo_create(priv->nav.surface); |
1241 |
cairo_set_operator(cr, CAIRO_OPERATOR_SOURCE); |
cairo_set_operator(cr, CAIRO_OPERATOR_SOURCE); |
1242 |
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); |
1243 |
cairo_paint(cr); |
cairo_paint(cr); |
1244 |
cairo_set_operator(cr, CAIRO_OPERATOR_OVER); |
cairo_set_operator(cr, CAIRO_OPERATOR_OVER); |
1245 |
|
|
1246 |
|
cairo_select_font_face (cr, "Sans", |
1247 |
|
CAIRO_FONT_SLANT_NORMAL, |
1248 |
|
CAIRO_FONT_WEIGHT_BOLD); |
1249 |
|
cairo_set_font_size (cr, OSD_COORDINATES_FONT_SIZE); |
1250 |
|
|
1251 |
|
char *latitude = osd_latitude_str(priv->nav.lat); |
1252 |
|
char *longitude = osd_longitude_str(priv->nav.lon); |
1253 |
|
|
1254 |
|
int y = OSD_COORDINATES_OFFSET; |
1255 |
|
y = osd_render_centered_text(cr, y, OSD_NAV_W, priv->nav.name); |
1256 |
|
y = osd_render_centered_text(cr, y, OSD_NAV_W, latitude); |
1257 |
|
y = osd_render_centered_text(cr, y, OSD_NAV_W, longitude); |
1258 |
|
|
1259 |
|
g_free(latitude); |
1260 |
|
g_free(longitude); |
1261 |
|
|
1262 |
|
/* draw the compass */ |
1263 |
|
int radius = (OSD_NAV_H - y - 5*OSD_COORDINATES_FONT_SIZE/4)/2; |
1264 |
|
if(radius > OSD_NAV_W/2) |
1265 |
|
radius = OSD_NAV_W/2; |
1266 |
|
|
1267 |
|
int x = OSD_NAV_W/2+1; |
1268 |
|
y += radius; |
1269 |
|
|
1270 |
|
cairo_stroke (cr); |
1271 |
|
|
1272 |
|
/* draw background */ |
1273 |
|
cairo_arc(cr, x, y, radius, 0, 2*M_PI); |
1274 |
|
cairo_set_source_rgba (cr, 1, 1, 1, 0.5); |
1275 |
|
cairo_fill_preserve (cr); |
1276 |
|
cairo_set_source_rgb (cr, 0, 0, 0); |
1277 |
|
cairo_set_line_width (cr, 1); |
1278 |
|
cairo_stroke (cr); |
1279 |
|
|
1280 |
|
/* draw pointer */ |
1281 |
|
#define ARROW_WIDTH 0.3 |
1282 |
|
#define ARROW_LENGTH 0.7 |
1283 |
|
|
1284 |
|
coord_t *gps = osm_gps_map_get_gps (OSM_GPS_MAP(osd->widget)); |
1285 |
|
if(gps) { |
1286 |
|
float arot = get_bearing(gps->rlat, gps->rlon, |
1287 |
|
deg2rad(priv->nav.lat), deg2rad(priv->nav.lon)); |
1288 |
|
|
1289 |
|
cairo_move_to(cr, |
1290 |
|
x + radius * ARROW_LENGTH * sin(arot), |
1291 |
|
y + radius * ARROW_LENGTH * -cos(arot)); |
1292 |
|
|
1293 |
|
cairo_line_to(cr, |
1294 |
|
x + radius * -ARROW_LENGTH * sin(arot+ARROW_WIDTH), |
1295 |
|
y + radius * -ARROW_LENGTH * -cos(arot+ARROW_WIDTH)); |
1296 |
|
|
1297 |
|
cairo_line_to(cr, |
1298 |
|
x + radius * -0.5 * ARROW_LENGTH * sin(arot), |
1299 |
|
y + radius * -0.5 * ARROW_LENGTH * -cos(arot)); |
1300 |
|
|
1301 |
|
cairo_line_to(cr, |
1302 |
|
x + radius * -ARROW_LENGTH * sin(arot-ARROW_WIDTH), |
1303 |
|
y + radius * -ARROW_LENGTH * -cos(arot-ARROW_WIDTH)); |
1304 |
|
|
1305 |
|
cairo_close_path(cr); |
1306 |
|
cairo_set_source_rgb (cr, 0, 0, 0); |
1307 |
|
cairo_fill (cr); |
1308 |
|
|
1309 |
|
y += radius + OSD_COORDINATES_FONT_SIZE/4; |
1310 |
|
|
1311 |
|
float dist = get_distance(gps->rlat, gps->rlon, |
1312 |
|
deg2rad(priv->nav.lat), deg2rad(priv->nav.lon)); |
1313 |
|
|
1314 |
|
char *dist_str = NULL; |
1315 |
|
if(dist<1000) |
1316 |
|
dist_str = g_strdup_printf("%u m", (int)dist); |
1317 |
|
else |
1318 |
|
dist_str = g_strdup_printf("%.1f km", dist/1000); |
1319 |
|
|
1320 |
|
y = osd_render_centered_text(cr, y, OSD_NAV_W, dist_str); |
1321 |
|
g_free(dist_str); |
1322 |
|
} |
1323 |
|
|
1324 |
cairo_destroy(cr); |
cairo_destroy(cr); |
1325 |
} |
} |
1326 |
|
|
1327 |
|
void osm_gps_map_osd_clear_nav (OsmGpsMap *map) { |
1328 |
|
g_return_if_fail (OSM_IS_GPS_MAP (map)); |
1329 |
|
|
1330 |
|
osm_gps_map_osd_t *osd = osm_gps_map_osd_get(map); |
1331 |
|
g_return_if_fail (osd); |
1332 |
|
|
1333 |
|
osd_priv_t *priv = (osd_priv_t*)osd->priv; |
1334 |
|
g_return_if_fail (priv); |
1335 |
|
|
1336 |
|
if(priv->nav.surface) { |
1337 |
|
cairo_surface_destroy(priv->nav.surface); |
1338 |
|
priv->nav.surface = NULL; |
1339 |
|
priv->nav.lat = OSM_GPS_MAP_INVALID; |
1340 |
|
priv->nav.lon = OSM_GPS_MAP_INVALID; |
1341 |
|
if(priv->nav.name) g_free(priv->nav.name); |
1342 |
|
} |
1343 |
|
osm_gps_map_redraw(map); |
1344 |
|
} |
1345 |
|
|
1346 |
|
void |
1347 |
|
osm_gps_map_osd_draw_nav (OsmGpsMap *map, float latitude, float longitude, |
1348 |
|
char *name) { |
1349 |
|
g_return_if_fail (OSM_IS_GPS_MAP (map)); |
1350 |
|
|
1351 |
|
osm_gps_map_osd_t *osd = osm_gps_map_osd_get(map); |
1352 |
|
g_return_if_fail (osd); |
1353 |
|
|
1354 |
|
osd_priv_t *priv = (osd_priv_t*)osd->priv; |
1355 |
|
g_return_if_fail (priv); |
1356 |
|
|
1357 |
|
osm_gps_map_osd_clear_nav (map); |
1358 |
|
|
1359 |
|
/* allocate balloon surface */ |
1360 |
|
priv->nav.surface = |
1361 |
|
cairo_image_surface_create(CAIRO_FORMAT_ARGB32, |
1362 |
|
OSD_NAV_W+2, OSD_NAV_H+2); |
1363 |
|
|
1364 |
|
priv->nav.lat = latitude; |
1365 |
|
priv->nav.lon = longitude; |
1366 |
|
priv->nav.name = g_strdup(name); |
1367 |
|
|
1368 |
|
osd_render_nav(osd); |
1369 |
|
|
1370 |
|
osm_gps_map_redraw(map); |
1371 |
|
} |
1372 |
|
|
1373 |
#endif // OSD_NAV |
#endif // OSD_NAV |
1374 |
|
|
1375 |
|
|
1748 |
priv->crosshair.rendered = FALSE; |
priv->crosshair.rendered = FALSE; |
1749 |
#endif |
#endif |
1750 |
|
|
|
#ifdef OSD_NAV |
|
|
priv->nav.surface = |
|
|
cairo_image_surface_create(CAIRO_FORMAT_ARGB32, |
|
|
OSD_NAV_W, OSD_NAV_H); |
|
|
#endif |
|
|
|
|
1751 |
#ifdef OSD_COORDINATES |
#ifdef OSD_COORDINATES |
1752 |
priv->coordinates.surface = |
priv->coordinates.surface = |
1753 |
cairo_image_surface_create(CAIRO_FORMAT_ARGB32, |
cairo_image_surface_create(CAIRO_FORMAT_ARGB32, |
1784 |
#endif |
#endif |
1785 |
|
|
1786 |
#ifdef OSD_NAV |
#ifdef OSD_NAV |
1787 |
x = OSD_X; |
if(priv->nav.surface) { |
1788 |
if(x < 0) x += osd->widget->allocation.width - OSD_NAV_W; |
x = OSD_X; |
1789 |
y = (osd->widget->allocation.height - OSD_NAV_H)/2; |
if(x < 0) x += osd->widget->allocation.width - OSD_NAV_W; |
1790 |
|
y = (osd->widget->allocation.height - OSD_NAV_H)/2; |
1791 |
cairo_set_source_surface(cr, priv->nav.surface, x, y); |
|
1792 |
cairo_paint(cr); |
cairo_set_source_surface(cr, priv->nav.surface, x, y); |
1793 |
|
cairo_paint(cr); |
1794 |
|
} |
1795 |
#endif |
#endif |
1796 |
|
|
1797 |
#ifdef OSD_COORDINATES |
#ifdef OSD_COORDINATES |