Check out the latest version of Routino: svn co http://routino.org/svn/trunk routino
Annotation of /trunk/src/segments.c
Parent Directory
|
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)
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. |