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/segmentsx.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 1100 - (hide annotations) (download) (as text)
Sat Oct 20 16:52:20 2012 UTC (12 years, 5 months ago) by amb
File MIME type: text/x-csrc
File size: 25182 byte(s)
Move the compacting of the ways back to the top, delete the unused ways at this
point and also call the function again after pruning segments.

1 amb 110 /***************************************
2     Extended Segment data type functions.
3 amb 151
4     Part of the Routino routing software.
5 amb 110 ******************/ /******************
6 amb 949 This file Copyright 2008-2012 Andrew M. Bishop
7 amb 110
8 amb 151 This program is free software: you can redistribute it and/or modify
9     it under the terms of the GNU Affero General Public License as published by
10     the Free Software Foundation, either version 3 of the License, or
11     (at your option) any later version.
12    
13     This program is distributed in the hope that it will be useful,
14     but WITHOUT ANY WARRANTY; without even the implied warranty of
15     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16     GNU Affero General Public License for more details.
17    
18     You should have received a copy of the GNU Affero General Public License
19     along with this program. If not, see <http://www.gnu.org/licenses/>.
20 amb 110 ***************************************/
21    
22    
23     #include <assert.h>
24     #include <math.h>
25     #include <stdlib.h>
26 amb 955 #include <string.h>
27 amb 110
28     #include "types.h"
29 amb 228 #include "segments.h"
30     #include "ways.h"
31 amb 110
32 amb 955 #include "typesx.h"
33 amb 449 #include "nodesx.h"
34     #include "segmentsx.h"
35     #include "waysx.h"
36 amb 110
37 amb 449 #include "files.h"
38 amb 519 #include "logging.h"
39 amb 532 #include "sorting.h"
40 amb 449
41    
42 amb 680 /* Global variables */
43 amb 110
44 amb 289 /*+ The command line '--tmpdir' option or its default value. +*/
45 amb 284 extern char *option_tmpdirname;
46 amb 110
47 amb 1100 /* Local variables */
48    
49     /*+ Temporary file-local variable for use by the sort functions. +*/
50     static SegmentsX *sortsegmentsx;
51    
52 amb 680 /* Local functions */
53 amb 110
54 amb 275 static int sort_by_id(SegmentX *a,SegmentX *b);
55 amb 949 static int delete_pruned(SegmentX *segmentx,index_t index);
56 amb 275
57 amb 228 static distance_t DistanceX(NodeX *nodex1,NodeX *nodex2);
58 amb 110
59    
60     /*++++++++++++++++++++++++++++++++++++++
61 amb 326 Allocate a new segment list (create a new file or open an existing one).
62 amb 110
63     SegmentsX *NewSegmentList Returns the segment list.
64 amb 326
65     int append Set to 1 if the file is to be opened for appending (now or later).
66 amb 110 ++++++++++++++++++++++++++++++++++++++*/
67    
68 amb 326 SegmentsX *NewSegmentList(int append)
69 amb 110 {
70     SegmentsX *segmentsx;
71    
72 amb 213 segmentsx=(SegmentsX*)calloc(1,sizeof(SegmentsX));
73 amb 110
74 amb 243 assert(segmentsx); /* Check calloc() worked */
75    
76 amb 284 segmentsx->filename=(char*)malloc(strlen(option_tmpdirname)+32);
77 amb 216
78 amb 326 if(append)
79 amb 447 sprintf(segmentsx->filename,"%s/segmentsx.input.tmp",option_tmpdirname);
80 amb 326 else
81 amb 788 sprintf(segmentsx->filename,"%s/segmentsx.%p.tmp",option_tmpdirname,(void*)segmentsx);
82 amb 256
83 amb 326 if(append)
84     {
85 amb 331 off_t size;
86 amb 326
87 amb 502 segmentsx->fd=OpenFileAppend(segmentsx->filename);
88 amb 326
89 amb 331 size=SizeFile(segmentsx->filename);
90 amb 326
91 amb 650 segmentsx->number=size/sizeof(SegmentX);
92 amb 326 }
93     else
94 amb 502 segmentsx->fd=OpenFileNew(segmentsx->filename);
95 amb 326
96 amb 110 return(segmentsx);
97     }
98    
99    
100     /*++++++++++++++++++++++++++++++++++++++
101 amb 226 Free a segment list.
102 amb 110
103 amb 681 SegmentsX *segmentsx The set of segments to be freed.
104 amb 326
105 amb 680 int keep Set to 1 if the file is to be kept (for appending later).
106 amb 110 ++++++++++++++++++++++++++++++++++++++*/
107    
108 amb 326 void FreeSegmentList(SegmentsX *segmentsx,int keep)
109 amb 110 {
110 amb 326 if(!keep)
111     DeleteFile(segmentsx->filename);
112    
113 amb 283 free(segmentsx->filename);
114 amb 256
115 amb 949 if(segmentsx->firstnode)
116     free(segmentsx->firstnode);
117    
118     if(segmentsx->next1)
119     free(segmentsx->next1);
120    
121 amb 643 if(segmentsx->usednode)
122     free(segmentsx->usednode);
123    
124 amb 110 free(segmentsx);
125     }
126    
127    
128     /*++++++++++++++++++++++++++++++++++++++
129 amb 493 Append a single segment to an unsorted segment list.
130 amb 110
131 amb 681 SegmentsX *segmentsx The set of segments to modify.
132 amb 110
133 amb 285 way_t way The way that the segment belongs to.
134    
135     node_t node1 The first node in the segment.
136    
137     node_t node2 The second node in the segment.
138    
139     distance_t distance The distance between the nodes (or just the flags).
140 amb 110 ++++++++++++++++++++++++++++++++++++++*/
141    
142 amb 681 void AppendSegment(SegmentsX *segmentsx,way_t way,node_t node1,node_t node2,distance_t distance)
143 amb 110 {
144 amb 285 SegmentX segmentx;
145 amb 110
146 amb 643 if(node1>node2)
147     {
148     node_t temp;
149    
150     temp=node1;
151     node1=node2;
152     node2=temp;
153    
154     if(distance&(ONEWAY_2TO1|ONEWAY_1TO2))
155     distance^=ONEWAY_2TO1|ONEWAY_1TO2;
156     }
157    
158 amb 285 segmentx.node1=node1;
159     segmentx.node2=node2;
160 amb 643 segmentx.next2=NO_SEGMENT;
161 amb 285 segmentx.way=way;
162     segmentx.distance=distance;
163 amb 110
164 amb 285 WriteFile(segmentsx->fd,&segmentx,sizeof(SegmentX));
165 amb 281
166 amb 650 segmentsx->number++;
167 amb 466
168 amb 650 assert(segmentsx->number<SEGMENT_FAKE); /* SEGMENT_FAKE marks the high-water mark for real segments. */
169 amb 285 }
170 amb 227
171 amb 281
172 amb 285 /*++++++++++++++++++++++++++++++++++++++
173     Sort the segment list.
174 amb 232
175 amb 949 SegmentsX *segmentsx The set of segments to sort and modify.
176 amb 1100 ++++++++++++++++++++++++++++++++++++++*/
177 amb 949
178 amb 1100 void SortSegmentList(SegmentsX *segmentsx)
179     {
180     int fd;
181    
182     /* Print the start message */
183    
184     printf_first("Sorting Segments");
185    
186     /* Close the file (finished appending) */
187    
188     if(segmentsx->fd!=-1)
189     segmentsx->fd=CloseFile(segmentsx->fd);
190    
191     /* Re-open the file read-only and a new file writeable */
192    
193     segmentsx->fd=ReOpenFile(segmentsx->filename);
194    
195     DeleteFile(segmentsx->filename);
196    
197     fd=OpenFileNew(segmentsx->filename);
198    
199     /* Sort by node indexes */
200    
201     filesort_fixed(segmentsx->fd,fd,sizeof(SegmentX),(int (*)(const void*,const void*))sort_by_id,NULL);
202    
203     /* Close the files */
204    
205     segmentsx->fd=CloseFile(segmentsx->fd);
206     CloseFile(fd);
207    
208     /* Print the final message */
209    
210     printf_last("Sorted Segments: Segments=%"Pindex_t,segmentsx->number);
211     }
212    
213    
214     /*++++++++++++++++++++++++++++++++++++++
215     Prune the deleted segments while resorting the list.
216    
217     SegmentsX *segmentsx The set of segments to sort and modify.
218    
219     WaysX *waysx The set of ways to check.
220 amb 285 ++++++++++++++++++++++++++++++++++++++*/
221 amb 110
222 amb 1100 void RemovePrunedSegments(SegmentsX *segmentsx,WaysX *waysx)
223 amb 285 {
224     int fd;
225 amb 949 index_t kept;
226 amb 243
227 amb 285 /* Print the start message */
228 amb 232
229 amb 1100 printf_first("Sorting Segments (Deleting Pruned, Checking Ways)");
230 amb 110
231 amb 555 /* Close the file (finished appending) */
232 amb 110
233 amb 700 if(segmentsx->fd!=-1)
234     segmentsx->fd=CloseFile(segmentsx->fd);
235 amb 555
236 amb 1100 /* Allocate the way usage bitmask */
237    
238     segmentsx->usedway=AllocBitMask(waysx->number);
239    
240     assert(segmentsx->usedway); /* Check AllocBitMask() worked */
241    
242 amb 555 /* Re-open the file read-only and a new file writeable */
243    
244 amb 285 segmentsx->fd=ReOpenFile(segmentsx->filename);
245 amb 110
246 amb 285 DeleteFile(segmentsx->filename);
247 amb 110
248 amb 502 fd=OpenFileNew(segmentsx->filename);
249 amb 110
250 amb 285 /* Sort by node indexes */
251 amb 132
252 amb 1100 sortsegmentsx=segmentsx;
253 amb 285
254 amb 1100 kept=filesort_fixed(segmentsx->fd,fd,sizeof(SegmentX),(int (*)(const void*,const void*))sort_by_id,(int (*)(void*,index_t))delete_pruned);
255    
256 amb 555 /* Close the files */
257 amb 285
258 amb 612 segmentsx->fd=CloseFile(segmentsx->fd);
259 amb 281 CloseFile(fd);
260    
261     /* Print the final message */
262    
263 amb 1100 printf_last("Sorted Segments: Segments=%"Pindex_t" Deleted=%"Pindex_t,kept,segmentsx->number-kept);
264     segmentsx->number=kept;
265 amb 110 }
266    
267    
268     /*++++++++++++++++++++++++++++++++++++++
269 amb 680 Sort the segments into id order, first by node1 then by node2, finally by distance.
270 amb 110
271 amb 285 int sort_by_id Returns the comparison of the node fields.
272 amb 110
273 amb 285 SegmentX *a The first segment.
274 amb 110
275 amb 285 SegmentX *b The second segment.
276 amb 256 ++++++++++++++++++++++++++++++++++++++*/
277    
278 amb 285 static int sort_by_id(SegmentX *a,SegmentX *b)
279 amb 256 {
280 amb 285 node_t a_id1=a->node1;
281     node_t b_id1=b->node1;
282 amb 256
283 amb 285 if(a_id1<b_id1)
284     return(-1);
285     else if(a_id1>b_id1)
286     return(1);
287     else /* if(a_id1==b_id1) */
288 amb 256 {
289 amb 285 node_t a_id2=a->node2;
290     node_t b_id2=b->node2;
291 amb 256
292 amb 285 if(a_id2<b_id2)
293     return(-1);
294     else if(a_id2>b_id2)
295     return(1);
296     else
297     {
298 amb 914 distance_t a_distance=DISTANCE(a->distance);
299     distance_t b_distance=DISTANCE(b->distance);
300 amb 256
301 amb 285 if(a_distance<b_distance)
302     return(-1);
303     else if(a_distance>b_distance)
304     return(1);
305     else
306     return(0);
307     }
308 amb 256 }
309     }
310    
311    
312     /*++++++++++++++++++++++++++++++++++++++
313 amb 949 Delete the pruned segments.
314    
315     int delete_pruned Return 1 if the value is to be kept, otherwise 0.
316    
317     SegmentX *segmentx The extended segment.
318    
319 amb 1100 index_t index The index of this segment in the total that have been kept.
320 amb 949 ++++++++++++++++++++++++++++++++++++++*/
321    
322     static int delete_pruned(SegmentX *segmentx,index_t index)
323     {
324     if(IsPrunedSegmentX(segmentx))
325     return(0);
326    
327 amb 1100 SetBit(sortsegmentsx->usedway,segmentx->way);
328    
329 amb 949 return(1);
330     }
331    
332    
333     /*++++++++++++++++++++++++++++++++++++++
334 amb 643 Find the first extended segment with a particular starting node index.
335    
336 amb 646 SegmentX *FirstSegmentX Returns a pointer to the first extended segment with the specified id.
337 amb 544
338 amb 681 SegmentsX *segmentsx The set of segments to use.
339 amb 544
340 amb 643 index_t nodeindex The node index to look for.
341    
342     int position A flag to pass through.
343     ++++++++++++++++++++++++++++++++++++++*/
344    
345 amb 681 SegmentX *FirstSegmentX(SegmentsX *segmentsx,index_t nodeindex,int position)
346 amb 643 {
347     index_t index=segmentsx->firstnode[nodeindex];
348     SegmentX *segmentx;
349    
350 amb 793 if(index==NO_SEGMENT)
351     return(NULL);
352    
353 amb 643 segmentx=LookupSegmentX(segmentsx,index,position);
354    
355     return(segmentx);
356     }
357    
358    
359     /*++++++++++++++++++++++++++++++++++++++
360     Find the next segment with a particular starting node index.
361    
362 amb 646 SegmentX *NextSegmentX Returns a pointer to the next segment with the same id.
363 amb 643
364 amb 681 SegmentsX *segmentsx The set of segments to use.
365 amb 544
366 amb 643 SegmentX *segmentx The current segment.
367 amb 544
368 amb 771 index_t nodeindex The node index.
369 amb 110 ++++++++++++++++++++++++++++++++++++++*/
370    
371 amb 943 SegmentX *NextSegmentX(SegmentsX *segmentsx,SegmentX *segmentx,index_t nodeindex)
372 amb 110 {
373 amb 943 #if SLIM
374     int position=1+(segmentx-&segmentsx->cached[0]);
375     #endif
376    
377 amb 771 if(segmentx->node1==nodeindex)
378 amb 643 {
379 amb 949 if(segmentsx->next1)
380     {
381     index_t index=IndexSegmentX(segmentsx,segmentx);
382    
383 amb 952 if(segmentsx->next1[index]==NO_SEGMENT)
384 amb 949 return(NULL);
385    
386     segmentx=LookupSegmentX(segmentsx,segmentsx->next1[index],position);
387    
388     return(segmentx);
389     }
390     else
391     {
392 amb 643 #if SLIM
393 amb 949 index_t index=IndexSegmentX(segmentsx,segmentx);
394     index++;
395 amb 544
396 amb 949 if(index>=segmentsx->number)
397     return(NULL);
398    
399     segmentx=LookupSegmentX(segmentsx,index,position);
400 amb 643 #else
401 amb 949 segmentx++;
402    
403     if(IndexSegmentX(segmentsx,segmentx)>=segmentsx->number)
404     return(NULL);
405     #endif
406    
407     if(segmentx->node1!=nodeindex)
408     return(NULL);
409    
410 amb 643 return(segmentx);
411 amb 949 }
412 amb 643 }
413 amb 229 else
414 amb 643 {
415     if(segmentx->next2==NO_SEGMENT)
416     return(NULL);
417 amb 949
418     return(LookupSegmentX(segmentsx,segmentx->next2,position));
419 amb 643 }
420 amb 110 }
421    
422    
423     /*++++++++++++++++++++++++++++++++++++++
424 amb 680 Remove bad segments (duplicated, zero length or with missing nodes).
425 amb 110
426 amb 681 NodesX *nodesx The set of nodes to use.
427 amb 195
428 amb 681 SegmentsX *segmentsx The set of segments to modify.
429 amb 110 ++++++++++++++++++++++++++++++++++++++*/
430    
431 amb 204 void RemoveBadSegments(NodesX *nodesx,SegmentsX *segmentsx)
432 amb 110 {
433 amb 780 index_t duplicate=0,loop=0,nonode=0,good=0,total=0;
434 amb 275 SegmentX segmentx;
435     int fd;
436 amb 755 node_t prevnode1=NO_NODE_ID,prevnode2=NO_NODE_ID;
437 amb 914 distance_t prevdist=0;
438 amb 110
439 amb 275 /* Print the start message */
440    
441 amb 761 printf_first("Checking Segments: Segments=0 Duplicate=0 Loop=0 No-Node=0");
442 amb 227
443 amb 1100 /* Allocate the node usage bitmask */
444 amb 643
445 amb 950 segmentsx->usednode=AllocBitMask(nodesx->number);
446 amb 643
447 amb 950 assert(segmentsx->usednode); /* Check AllocBitMask() worked */
448 amb 643
449 amb 555 /* Re-open the file read-only and a new file writeable */
450 amb 275
451 amb 555 segmentsx->fd=ReOpenFile(segmentsx->filename);
452    
453 amb 275 DeleteFile(segmentsx->filename);
454    
455 amb 502 fd=OpenFileNew(segmentsx->filename);
456 amb 275
457 amb 555 /* Modify the on-disk image */
458    
459 amb 275 while(!ReadFile(segmentsx->fd,&segmentx,sizeof(SegmentX)))
460 amb 110 {
461 amb 643 index_t index1=IndexNodeX(nodesx,segmentx.node1);
462     index_t index2=IndexNodeX(nodesx,segmentx.node2);
463    
464 amb 275 if(prevnode1==segmentx.node1 && prevnode2==segmentx.node2)
465 amb 812 {
466 amb 914 if(!prevdist && !DISTANCE(segmentx.distance))
467     logerror("Segment connecting nodes %"Pnode_t" and %"Pnode_t" is duplicated.\n",segmentx.node1,segmentx.node2);
468 amb 812
469 amb 914 if(!prevdist && DISTANCE(segmentx.distance))
470     logerror("Segment connecting nodes %"Pnode_t" and %"Pnode_t" is duplicated (discarded the area).\n",segmentx.node1,segmentx.node2);
471    
472     if(prevdist && !DISTANCE(segmentx.distance))
473     logerror("Segment connecting nodes %"Pnode_t" and %"Pnode_t" is duplicated (discarded the non-area).\n",segmentx.node1,segmentx.node2);
474    
475     if(prevdist && DISTANCE(segmentx.distance))
476     logerror("Segment connecting nodes %"Pnode_t" and %"Pnode_t" is duplicated (both are areas).\n",segmentx.node1,segmentx.node2);
477    
478 amb 275 duplicate++;
479 amb 812 }
480 amb 275 else if(segmentx.node1==segmentx.node2)
481 amb 812 {
482     logerror("Segment connects node %"Pnode_t" to itself.\n",segmentx.node1);
483    
484 amb 257 loop++;
485 amb 812 }
486 amb 643 else if(index1==NO_NODE || index2==NO_NODE)
487 amb 812 {
488     if(index1==NO_NODE && index2==NO_NODE)
489     logerror("Segment connects nodes %"Pnode_t" and %"Pnode_t" but neither exist.\n",segmentx.node1,segmentx.node2);
490    
491     if(index1==NO_NODE && index2!=NO_NODE)
492     logerror("Segment connects nodes %"Pnode_t" and %"Pnode_t" but the first one does not exist.\n",segmentx.node1,segmentx.node2);
493    
494     if(index1!=NO_NODE && index2==NO_NODE)
495     logerror("Segment connects nodes %"Pnode_t" and %"Pnode_t" but the second one does not exist.\n",segmentx.node1,segmentx.node2);
496    
497 amb 761 nonode++;
498 amb 812 }
499 amb 275 else
500 amb 257 {
501 amb 275 WriteFile(fd,&segmentx,sizeof(SegmentX));
502    
503 amb 655 SetBit(segmentsx->usednode,index1);
504     SetBit(segmentsx->usednode,index2);
505 amb 643
506 amb 275 good++;
507    
508     prevnode1=segmentx.node1;
509     prevnode2=segmentx.node2;
510 amb 914 prevdist=DISTANCE(segmentx.distance);
511 amb 110 }
512    
513 amb 275 total++;
514 amb 256
515 amb 275 if(!(total%10000))
516 amb 790 printf_middle("Checking Segments: Segments=%"Pindex_t" Duplicate=%"Pindex_t" Loop=%"Pindex_t" No-Node=%"Pindex_t,total,duplicate,loop,nonode);
517 amb 110 }
518    
519 amb 555 segmentsx->number=good;
520 amb 275
521 amb 555 /* Close the files */
522    
523 amb 612 segmentsx->fd=CloseFile(segmentsx->fd);
524 amb 275 CloseFile(fd);
525    
526     /* Print the final message */
527    
528 amb 790 printf_last("Checked Segments: Segments=%"Pindex_t" Duplicate=%"Pindex_t" Loop=%"Pindex_t" No-Node=%"Pindex_t,total,duplicate,loop,nonode);
529 amb 110 }
530    
531    
532     /*++++++++++++++++++++++++++++++++++++++
533 amb 285 Measure the segments and replace node/way ids with indexes.
534 amb 110
535 amb 681 SegmentsX *segmentsx The set of segments to process.
536 amb 110
537 amb 680 NodesX *nodesx The set of nodes to use.
538 amb 279
539 amb 680 WaysX *waysx The set of ways to use.
540 amb 110 ++++++++++++++++++++++++++++++++++++++*/
541    
542 amb 681 void MeasureSegments(SegmentsX *segmentsx,NodesX *nodesx,WaysX *waysx)
543 amb 110 {
544 amb 279 index_t index=0;
545 amb 643 int fd;
546 amb 256 SegmentX segmentx;
547 amb 110
548 amb 275 /* Print the start message */
549    
550 amb 519 printf_first("Measuring Segments: Segments=0");
551 amb 227
552 amb 555 /* Map into memory / open the file */
553 amb 257
554 amb 452 #if !SLIM
555 amb 651 nodesx->data=MapFile(nodesx->filename);
556 amb 555 #else
557     nodesx->fd=ReOpenFile(nodesx->filename);
558 amb 452 #endif
559 amb 258
560 amb 1100 /* Allocate the way usage bitmask */
561    
562     segmentsx->usedway=AllocBitMask(waysx->number);
563    
564     assert(segmentsx->usedway); /* Check AllocBitMask() worked */
565    
566 amb 555 /* Re-open the file read-only and a new file writeable */
567 amb 275
568 amb 555 segmentsx->fd=ReOpenFile(segmentsx->filename);
569    
570 amb 256 DeleteFile(segmentsx->filename);
571    
572 amb 502 fd=OpenFileNew(segmentsx->filename);
573 amb 256
574 amb 555 /* Modify the on-disk image */
575    
576 amb 256 while(!ReadFile(segmentsx->fd,&segmentx,sizeof(SegmentX)))
577 amb 110 {
578 amb 279 index_t node1=IndexNodeX(nodesx,segmentx.node1);
579     index_t node2=IndexNodeX(nodesx,segmentx.node2);
580     index_t way =IndexWayX (waysx ,segmentx.way);
581 amb 110
582 amb 279 NodeX *nodex1=LookupNodeX(nodesx,node1,1);
583     NodeX *nodex2=LookupNodeX(nodesx,node2,2);
584    
585     /* Replace the node and way ids with their indexes */
586    
587     segmentx.node1=node1;
588     segmentx.node2=node2;
589     segmentx.way =way;
590    
591 amb 1100 SetBit(segmentsx->usedway,segmentx.way);
592    
593 amb 949 /* Set the distance but preserve the other flags */
594 amb 275
595     segmentx.distance|=DISTANCE(DistanceX(nodex1,nodex2));
596    
597 amb 279 /* Write the modified segment */
598    
599 amb 275 WriteFile(fd,&segmentx,sizeof(SegmentX));
600    
601 amb 279 index++;
602 amb 275
603 amb 279 if(!(index%10000))
604 amb 790 printf_middle("Measuring Segments: Segments=%"Pindex_t,index);
605 amb 275 }
606 amb 110
607 amb 555 /* Close the files */
608 amb 257
609 amb 612 segmentsx->fd=CloseFile(segmentsx->fd);
610 amb 275 CloseFile(fd);
611    
612 amb 280 /* Free the other now-unneeded indexes */
613 amb 279
614     free(nodesx->idata);
615     nodesx->idata=NULL;
616    
617     free(waysx->idata);
618     waysx->idata=NULL;
619    
620 amb 555 /* Unmap from memory / close the file */
621 amb 275
622 amb 452 #if !SLIM
623 amb 651 nodesx->data=UnmapFile(nodesx->filename);
624 amb 555 #else
625 amb 612 nodesx->fd=CloseFile(nodesx->fd);
626 amb 452 #endif
627 amb 275
628     /* Print the final message */
629    
630 amb 790 printf_last("Measured Segments: Segments=%"Pindex_t,segmentsx->number);
631 amb 275 }
632    
633    
634     /*++++++++++++++++++++++++++++++++++++++
635     Remove the duplicate segments.
636 amb 110
637 amb 681 SegmentsX *segmentsx The set of segments to modify.
638 amb 110
639 amb 680 NodesX *nodesx The set of nodes to use.
640 amb 279
641 amb 680 WaysX *waysx The set of ways to use.
642 amb 110 ++++++++++++++++++++++++++++++++++++++*/
643    
644 amb 681 void DeduplicateSegments(SegmentsX *segmentsx,NodesX *nodesx,WaysX *waysx)
645 amb 110 {
646 amb 780 index_t duplicate=0,good=0;
647 amb 658 index_t index=0;
648     int fd,nprev=0;
649 amb 770 index_t prevnode1=NO_NODE,prevnode2=NO_NODE;
650 amb 759 SegmentX prevsegx[MAX_SEG_PER_NODE],segmentx;
651     Way prevway[MAX_SEG_PER_NODE];
652 amb 110
653 amb 275 /* Print the start message */
654    
655 amb 519 printf_first("Deduplicating Segments: Segments=0 Duplicate=0");
656 amb 227
657 amb 555 /* Map into memory / open the file */
658 amb 256
659 amb 452 #if !SLIM
660 amb 651 waysx->data=MapFile(waysx->filename);
661 amb 555 #else
662     waysx->fd=ReOpenFile(waysx->filename);
663 amb 452 #endif
664 amb 275
665 amb 555 /* Re-open the file read-only and a new file writeable */
666 amb 275
667 amb 555 segmentsx->fd=ReOpenFile(segmentsx->filename);
668    
669 amb 275 DeleteFile(segmentsx->filename);
670    
671 amb 502 fd=OpenFileNew(segmentsx->filename);
672 amb 275
673 amb 555 /* Modify the on-disk image */
674    
675 amb 275 while(!ReadFile(segmentsx->fd,&segmentx,sizeof(SegmentX)))
676 amb 110 {
677 amb 657 WayX *wayx=LookupWayX(waysx,segmentx.way,1);
678 amb 275 int isduplicate=0;
679 amb 256
680 amb 658 if(segmentx.node1==prevnode1 && segmentx.node2==prevnode2)
681 amb 110 {
682 amb 658 int offset;
683 amb 110
684 amb 658 for(offset=0;offset<nprev;offset++)
685 amb 110 {
686 amb 658 if(DISTFLAG(segmentx.distance)==DISTFLAG(prevsegx[offset].distance))
687 amb 657 if(!WaysCompare(&prevway[offset],&wayx->way))
688 amb 264 {
689 amb 275 isduplicate=1;
690     break;
691 amb 264 }
692 amb 658 }
693 amb 264
694 amb 658 if(isduplicate)
695     {
696     nprev--;
697    
698     for(;offset<nprev;offset++)
699     {
700     prevsegx[offset]=prevsegx[offset+1];
701     prevway[offset] =prevway[offset+1];
702     }
703 amb 110 }
704 amb 658 else
705     {
706 amb 759 assert(nprev<MAX_SEG_PER_NODE); /* Only a limited amount of information stored. */
707 amb 275
708 amb 658 prevsegx[nprev]=segmentx;
709     prevway[nprev] =wayx->way;
710 amb 666
711     nprev++;
712 amb 658 }
713 amb 110 }
714 amb 264 else
715     {
716 amb 658 nprev=1;
717     prevnode1=segmentx.node1;
718     prevnode2=segmentx.node2;
719     prevsegx[0]=segmentx;
720     prevway[0] =wayx->way;
721 amb 264 }
722 amb 110
723 amb 640 if(isduplicate)
724     duplicate++;
725     else
726 amb 110 {
727 amb 275 WriteFile(fd,&segmentx,sizeof(SegmentX));
728    
729     good++;
730     }
731    
732     index++;
733    
734     if(!(index%10000))
735 amb 790 printf_middle("Deduplicating Segments: Segments=%"Pindex_t" Duplicate=%"Pindex_t,index,duplicate);
736 amb 110 }
737    
738 amb 555 segmentsx->number=good;
739 amb 275
740 amb 555 /* Close the files */
741    
742 amb 612 segmentsx->fd=CloseFile(segmentsx->fd);
743 amb 275 CloseFile(fd);
744    
745 amb 555 /* Unmap from memory / close the file */
746 amb 275
747 amb 452 #if !SLIM
748 amb 651 waysx->data=UnmapFile(waysx->filename);
749 amb 555 #else
750 amb 612 waysx->fd=CloseFile(waysx->fd);
751 amb 452 #endif
752 amb 275
753     /* Print the final message */
754    
755 amb 790 printf_last("Deduplicated Segments: Segments=%"Pindex_t" Duplicate=%"Pindex_t" Unique=%"Pindex_t,index,duplicate,good);
756 amb 110 }
757    
758    
759     /*++++++++++++++++++++++++++++++++++++++
760 amb 680 Index the segments by creating the firstnode index and filling in the segment next2 parameter.
761 amb 209
762 amb 681 SegmentsX *segmentsx The set of segments to modify.
763 amb 209
764 amb 1100 NodesX *nodesx The set of nodes to use.
765    
766     WaysX *waysx The set of ways to use.
767 amb 209 ++++++++++++++++++++++++++++++++++++++*/
768    
769 amb 1100 void IndexSegments(SegmentsX *segmentsx,NodesX *nodesx,WaysX *waysx)
770 amb 209 {
771 amb 780 index_t index,i;
772 amb 209
773 amb 660 if(segmentsx->number==0)
774     return;
775    
776 amb 275 /* Print the start message */
777    
778 amb 643 printf_first("Indexing Segments: Segments=0");
779 amb 227
780 amb 643 /* Allocate the array of indexes */
781    
782     if(!segmentsx->firstnode)
783     {
784 amb 674 segmentsx->firstnode=(index_t*)malloc(nodesx->number*sizeof(index_t));
785 amb 643
786     assert(segmentsx->firstnode); /* Check malloc() worked */
787     }
788    
789     for(i=0;i<nodesx->number;i++)
790     segmentsx->firstnode[i]=NO_SEGMENT;
791    
792 amb 555 /* Map into memory / open the files */
793 amb 209
794 amb 452 #if !SLIM
795 amb 651 segmentsx->data=MapFileWriteable(segmentsx->filename);
796 amb 555 #else
797 amb 643 segmentsx->fd=ReOpenFileWriteable(segmentsx->filename);
798 amb 452 #endif
799 amb 275
800 amb 643 /* Read through the segments in reverse order */
801 amb 280
802 amb 643 for(index=segmentsx->number-1;index!=NO_SEGMENT;index--)
803 amb 209 {
804 amb 643 SegmentX *segmentx=LookupSegmentX(segmentsx,index,1);
805 amb 209
806 amb 1098 if(nodesx->pdata)
807     {
808     segmentx->node1=nodesx->pdata[segmentx->node1];
809     segmentx->node2=nodesx->pdata[segmentx->node2];
810     }
811    
812 amb 1100 if(waysx->cdata)
813     {
814     //printf("segment=%ld segment->way=%ld waysx->cdata[segmentx->way]=%ld\n",index,segmentx->way,waysx->cdata[segmentx->way]);
815     segmentx->way=waysx->cdata[segmentx->way];
816     }
817    
818 amb 674 segmentx->next2=segmentsx->firstnode[segmentx->node2];
819 amb 209
820 amb 942 PutBackSegmentX(segmentsx,segmentx);
821 amb 448
822 amb 643 segmentsx->firstnode[segmentx->node1]=index;
823     segmentsx->firstnode[segmentx->node2]=index;
824 amb 558
825 amb 643 if(!(index%10000))
826 amb 790 printf_middle("Indexing Segments: Segments=%"Pindex_t,segmentsx->number-index);
827 amb 209 }
828    
829 amb 555 /* Unmap from memory / close the files */
830 amb 275
831 amb 452 #if !SLIM
832 amb 651 segmentsx->data=UnmapFile(segmentsx->filename);
833 amb 555 #else
834 amb 643 segmentsx->fd=CloseFile(segmentsx->fd);
835 amb 452 #endif
836 amb 275
837 amb 1100 /* Free the memory */
838    
839     if(nodesx->pdata)
840     {
841     free(nodesx->pdata);
842     nodesx->pdata=NULL;
843     }
844    
845     if(waysx->cdata)
846     {
847     free(waysx->cdata);
848     waysx->cdata=NULL;
849     }
850    
851 amb 275 /* Print the final message */
852    
853 amb 790 printf_last("Indexed Segments: Segments=%"Pindex_t,segmentsx->number);
854 amb 209 }
855    
856    
857     /*++++++++++++++++++++++++++++++++++++++
858 amb 643 Update the segment indexes after geographical sorting.
859 amb 110
860 amb 681 SegmentsX *segmentsx The set of segments to modify.
861 amb 110
862 amb 643 NodesX *nodesx The set of nodes to use.
863    
864 amb 740 WaysX *waysx The set of ways to use.
865 amb 110 ++++++++++++++++++++++++++++++++++++++*/
866    
867 amb 644 void UpdateSegments(SegmentsX *segmentsx,NodesX *nodesx,WaysX *waysx)
868 amb 110 {
869 amb 214 index_t i;
870 amb 643 int fd;
871 amb 110
872 amb 275 /* Print the start message */
873    
874 amb 674 printf_first("Updating Segments: Segments=0");
875 amb 227
876 amb 555 /* Map into memory / open the files */
877 amb 275
878 amb 452 #if !SLIM
879 amb 651 waysx->data=MapFile(waysx->filename);
880 amb 555 #else
881 amb 643 waysx->fd=ReOpenFile(waysx->filename);
882 amb 452 #endif
883 amb 275
884 amb 643 /* Re-open the file read-only and a new file writeable */
885 amb 110
886 amb 643 segmentsx->fd=ReOpenFile(segmentsx->filename);
887 amb 110
888 amb 643 DeleteFile(segmentsx->filename);
889 amb 256
890 amb 643 fd=OpenFileNew(segmentsx->filename);
891 amb 110
892 amb 643 /* Modify the on-disk image */
893 amb 641
894 amb 643 for(i=0;i<segmentsx->number;i++)
895     {
896     SegmentX segmentx;
897 amb 448
898 amb 643 ReadFile(segmentsx->fd,&segmentx,sizeof(SegmentX));
899 amb 128
900 amb 643 segmentx.node1=nodesx->gdata[segmentx.node1];
901     segmentx.node2=nodesx->gdata[segmentx.node2];
902 amb 256
903 amb 674 if(segmentx.node1>segmentx.node2)
904     {
905     index_t temp;
906    
907     temp=segmentx.node1;
908     segmentx.node1=segmentx.node2;
909     segmentx.node2=temp;
910    
911     if(segmentx.distance&(ONEWAY_2TO1|ONEWAY_1TO2))
912     segmentx.distance^=ONEWAY_2TO1|ONEWAY_1TO2;
913     }
914    
915 amb 643 WriteFile(fd,&segmentx,sizeof(SegmentX));
916 amb 448
917 amb 110 if(!((i+1)%10000))
918 amb 790 printf_middle("Updating Segments: Segments=%"Pindex_t,i+1);
919 amb 110 }
920    
921 amb 643 /* Close the files */
922    
923     segmentsx->fd=CloseFile(segmentsx->fd);
924     CloseFile(fd);
925    
926 amb 555 /* Unmap from memory / close the files */
927 amb 275
928 amb 452 #if !SLIM
929 amb 651 waysx->data=UnmapFile(waysx->filename);
930 amb 555 #else
931 amb 643 waysx->fd=CloseFile(waysx->fd);
932 amb 452 #endif
933 amb 275
934     /* Print the final message */
935    
936 amb 790 printf_last("Updated Segments: Segments=%"Pindex_t,segmentsx->number);
937 amb 110 }
938    
939    
940     /*++++++++++++++++++++++++++++++++++++++
941 amb 285 Save the segment list to a file.
942    
943 amb 681 SegmentsX *segmentsx The set of segments to save.
944 amb 285
945     const char *filename The name of the file to save.
946     ++++++++++++++++++++++++++++++++++++++*/
947    
948 amb 681 void SaveSegmentList(SegmentsX *segmentsx,const char *filename)
949 amb 285 {
950     index_t i;
951     int fd;
952 amb 500 SegmentsFile segmentsfile={0};
953 amb 780 index_t super_number=0,normal_number=0;
954 amb 285
955     /* Print the start message */
956    
957 amb 519 printf_first("Writing Segments: Segments=0");
958 amb 285
959 amb 558 /* Re-open the file */
960    
961 amb 643 segmentsx->fd=ReOpenFile(segmentsx->filename);
962 amb 558
963 amb 461 /* Write out the segments data */
964 amb 285
965 amb 502 fd=OpenFileNew(filename);
966 amb 461
967     SeekFile(fd,sizeof(SegmentsFile));
968    
969 amb 285 for(i=0;i<segmentsx->number;i++)
970     {
971 amb 643 SegmentX segmentx;
972 amb 944 Segment segment={0};
973 amb 448
974 amb 643 ReadFile(segmentsx->fd,&segmentx,sizeof(SegmentX));
975 amb 558
976 amb 643 segment.node1 =segmentx.node1;
977     segment.node2 =segmentx.node2;
978     segment.next2 =segmentx.next2;
979     segment.way =segmentx.way;
980     segment.distance=segmentx.distance;
981    
982 amb 558 if(IsSuperSegment(&segment))
983 amb 285 super_number++;
984 amb 558 if(IsNormalSegment(&segment))
985 amb 285 normal_number++;
986    
987 amb 558 WriteFile(fd,&segment,sizeof(Segment));
988 amb 448
989 amb 285 if(!((i+1)%10000))
990 amb 790 printf_middle("Writing Segments: Segments=%"Pindex_t,i+1);
991 amb 285 }
992    
993 amb 461 /* Write out the header structure */
994    
995     segmentsfile.number=segmentsx->number;
996     segmentsfile.snumber=super_number;
997     segmentsfile.nnumber=normal_number;
998    
999     SeekFile(fd,0);
1000     WriteFile(fd,&segmentsfile,sizeof(SegmentsFile));
1001    
1002 amb 285 CloseFile(fd);
1003    
1004 amb 558 /* Close the file */
1005    
1006 amb 643 segmentsx->fd=CloseFile(segmentsx->fd);
1007 amb 558
1008 amb 285 /* Print the final message */
1009    
1010 amb 790 printf_last("Wrote Segments: Segments=%"Pindex_t,segmentsx->number);
1011 amb 285 }
1012    
1013    
1014     /*++++++++++++++++++++++++++++++++++++++
1015 amb 110 Calculate the distance between two nodes.
1016    
1017     distance_t DistanceX Returns the distance between the extended nodes.
1018    
1019     NodeX *nodex1 The starting node.
1020    
1021     NodeX *nodex2 The end node.
1022     ++++++++++++++++++++++++++++++++++++++*/
1023    
1024 amb 228 static distance_t DistanceX(NodeX *nodex1,NodeX *nodex2)
1025 amb 110 {
1026 amb 223 double dlon = latlong_to_radians(nodex1->longitude) - latlong_to_radians(nodex2->longitude);
1027     double dlat = latlong_to_radians(nodex1->latitude) - latlong_to_radians(nodex2->latitude);
1028     double lat1 = latlong_to_radians(nodex1->latitude);
1029     double lat2 = latlong_to_radians(nodex2->latitude);
1030 amb 110
1031 amb 219 double a1,a2,a,sa,c,d;
1032 amb 110
1033     if(dlon==0 && dlat==0)
1034     return 0;
1035    
1036 amb 219 a1 = sin (dlat / 2);
1037     a2 = sin (dlon / 2);
1038     a = (a1 * a1) + cos (lat1) * cos (lat2) * a2 * a2;
1039     sa = sqrt (a);
1040 amb 110 if (sa <= 1.0)
1041 amb 219 {c = 2 * asin (sa);}
1042 amb 110 else
1043 amb 219 {c = 2 * asin (1.0);}
1044 amb 110 d = 6378.137 * c;
1045    
1046     return km_to_distance(d);
1047     }

Properties

Name Value
cvs:description Extended segments functions.