markus/lifo-dijkstraserv
1
0
Fork 0
Code Issues 3 Pull Requests Releases Wiki Activity

Fix walking direction heading

Browse Source
This commit is contained in:
Markus Koch 2020-05-06 14:13:04 +02:00
parent d219007e71
commit 0fbbd374a7
1 changed files with 3 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/dijkstrasearch.c
View File

@ -248,11 +248,10 @@ int dijkstra_search_route_to_geojson(struct dijkstra_search *search,
for (l = route; l != NULL; l = l->next) {
node = (struct dijkstra_node*) l->data;
if (node_last) {
heading = atanf((node->position.y - node_last->position.y) / (node->position.x - node_last->position.x)) / (M_PI * 2) * 360;
heading = atanf((node->position.y - node_last->position.y) / (node->position.x - node_last->position.x)) / (M_PI * 2) * 360;
if (last_heading - heading > 10) {
heading = atan2f((node->position.y - node_last->position.y), (node->position.x - node_last->position.x)) / (M_PI * 2) * 360;
if (last_heading - heading > 25) {
relative_direction_str = "right";
} else if (last_heading - heading < -10) {
} else if (last_heading - heading < -25) {
relative_direction_str = "left";
} else {
relative_direction_str = "straight";