Routino SVN Repository Browser

Check out the latest version of Routino: svn co http://routino.org/svn/trunk routino

ViewVC logotype

Annotation of /trunk/src/segments.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 228 - (hide annotations) (download) (as text)
Sun Jul 12 09:01:48 2009 UTC (15 years, 8 months ago) by amb
File MIME type: text/x-csrc
File size: 4395 byte(s)
Tidy up and fix comments and include files.

1 amb 2 /***************************************
2 amb 228 $Header: /home/amb/CVS/routino/src/segments.c,v 1.43 2009-07-12 09:01:48 amb Exp $
3 amb 2
4     Segment data type functions.
5 amb 151
6     Part of the Routino routing software.
7 amb 2 ******************/ /******************
8 amb 151 This file Copyright 2008,2009 Andrew M. Bishop
9 amb 2
10 amb 151 This program is free software: you can redistribute it and/or modify
11     it under the terms of the GNU Affero General Public License as published by
12     the Free Software Foundation, either version 3 of the License, or
13     (at your option) any later version.
14    
15     This program is distributed in the hope that it will be useful,
16     but WITHOUT ANY WARRANTY; without even the implied warranty of
17     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18     GNU Affero General Public License for more details.
19    
20     You should have received a copy of the GNU Affero General Public License
21     along with this program. If not, see <http://www.gnu.org/licenses/>.
22 amb 2 ***************************************/
23    
24    
25 amb 214 #include <sys/types.h>
26 amb 2 #include <stdlib.h>
27    
28 amb 109 #include "types.h"
29     #include "functions.h"
30 amb 39 #include "nodes.h"
31 amb 26 #include "segments.h"
32 amb 109 #include "ways.h"
33     #include "profiles.h"
34 amb 2
35    
36 amb 23 /*++++++++++++++++++++++++++++++++++++++
37 amb 2 Load in a segment list from a file.
38    
39 amb 228 Segments* LoadSegmentList Returns the segment list that has just been loaded.
40 amb 23
41 amb 2 const char *filename The name of the file to load.
42     ++++++++++++++++++++++++++++++++++++++*/
43    
44 amb 23 Segments *LoadSegmentList(const char *filename)
45 amb 2 {
46 amb 88 void *data;
47     Segments *segments;
48    
49     segments=(Segments*)malloc(sizeof(Segments));
50    
51     data=MapFile(filename);
52    
53 amb 100 if(!data)
54     return(NULL);
55    
56 amb 88 /* Copy the Segments structure from the loaded data */
57    
58     *segments=*((Segments*)data);
59    
60     /* Adjust the pointers in the Segments structure. */
61    
62 amb 104 segments->data=data;
63 amb 88 segments->segments=(Segment*)(data+(off_t)segments->segments);
64    
65     return(segments);
66 amb 2 }
67    
68    
69     /*++++++++++++++++++++++++++++++++++++++
70     Find the next segment with a particular starting node.
71    
72 amb 88 Segment *NextSegment Returns a pointer to the next segment with the same id.
73 amb 2
74 amb 23 Segments* segments The set of segments to process.
75    
76 amb 2 Segment *segment The current segment.
77 amb 228
78     index_t node The current node.
79 amb 2 ++++++++++++++++++++++++++++++++++++++*/
80    
81 amb 104 Segment *NextSegment(Segments* segments,Segment *segment,index_t node)
82 amb 2 {
83 amb 208 if(segment->node1==node)
84 amb 128 {
85     segment++;
86 amb 214 if((segment-segments->segments)>=segments->number || segment->node1!=node)
87 amb 128 return(NULL);
88     else
89     return(segment);
90     }
91 amb 104 else
92 amb 128 {
93 amb 176 if(segment->next2==NO_NODE)
94 amb 128 return(NULL);
95     else
96     return(LookupSegment(segments,segment->next2));
97     }
98 amb 89 }
99 amb 88
100    
101 amb 2 /*++++++++++++++++++++++++++++++++++++++
102 amb 99 Calculate the distance between two locations.
103    
104 amb 114 distance_t Distance Returns the distance between the locations.
105 amb 99
106 amb 219 double lat1 The latitude of the first location.
107 amb 99
108 amb 219 double lon1 The longitude of the first location.
109 amb 99
110 amb 219 double lat2 The latitude of the second location.
111 amb 99
112 amb 219 double lon2 The longitude of the second location.
113 amb 99 ++++++++++++++++++++++++++++++++++++++*/
114    
115 amb 219 distance_t Distance(double lat1,double lon1,double lat2,double lon2)
116 amb 99 {
117 amb 219 double dlon = lon1 - lon2;
118     double dlat = lat1 - lat2;
119 amb 99
120 amb 219 double a1,a2,a,sa,c,d;
121 amb 99
122     if(dlon==0 && dlat==0)
123     return 0;
124    
125 amb 219 a1 = sin (dlat / 2);
126     a2 = sin (dlon / 2);
127     a = (a1 * a1) + cos (lat1) * cos (lat2) * a2 * a2;
128     sa = sqrt (a);
129 amb 99 if (sa <= 1.0)
130 amb 219 {c = 2 * asin (sa);}
131 amb 99 else
132 amb 219 {c = 2 * asin (1.0);}
133 amb 99 d = 6378.137 * c;
134    
135 amb 114 return km_to_distance(d);
136 amb 99 }
137    
138    
139     /*++++++++++++++++++++++++++++++++++++++
140 amb 63 Calculate the duration of segment.
141    
142     duration_t Duration Returns the duration of travel between the nodes.
143    
144     Segment *segment The segment to traverse.
145    
146     Way *way The way that the segment belongs to.
147    
148 amb 82 Profile *profile The profile of the transport being used.
149 amb 63 ++++++++++++++++++++++++++++++++++++++*/
150    
151 amb 82 duration_t Duration(Segment *segment,Way *way,Profile *profile)
152 amb 63 {
153 amb 137 speed_t speed1=way->speed;
154     speed_t speed2=profile->speed[HIGHWAY(way->type)];
155 amb 90 distance_t distance=DISTANCE(segment->distance);
156 amb 63
157 amb 137 if(speed1==0)
158     {
159     if(speed2==0)
160     return(hours_to_duration(10));
161     else
162     return distance_speed_to_duration(distance,speed2);
163     }
164     else /* if(speed1!=0) */
165     {
166     if(speed2==0)
167     return distance_speed_to_duration(distance,speed1);
168     else if(speed1<=speed2)
169     return distance_speed_to_duration(distance,speed1);
170     else
171     return distance_speed_to_duration(distance,speed2);
172     }
173 amb 63 }

Properties

Name Value
cvs:description Segment data type.