Some QuadTree fixes.
[ipdf/code.git] / src / document.cpp
1 #include "document.h"
2 #include "bezier.h"
3 #include <cstdio>
4 #include <fstream>
5
6 using namespace IPDF;
7 using namespace std;
8
9 //TODO: Make this work for variable sized Reals
10
11 // Loads an std::vector<T> of size num_elements from a file.
12 template<typename T>
13 static void LoadStructVector(FILE *src_file, size_t num_elems, std::vector<T>& dest)
14 {
15         size_t structsread = 0;
16         dest.resize(num_elems);
17         structsread = fread(dest.data(), sizeof(T), num_elems, src_file);
18         if (structsread != num_elems)
19                 Fatal("Only read %u structs (expected %u)!", structsread, num_elems);
20 }
21
22 // Saves an std::vector<T> to a file. Size must be saves separately.
23 template<typename T>
24 static void SaveStructVector(FILE *dst_file, std::vector<T>& src)
25 {
26         size_t written = 0;
27         written = fwrite(src.data(), sizeof(T), src.size(), dst_file);
28         if (written != src.size())
29                 Fatal("Only wrote %u structs (expected %u)!", written, src.size());
30 }
31
32 static void WriteChunkHeader(FILE *dst_file, DocChunkTypes type, uint32_t size)
33 {
34         size_t written = 0;
35         written = fwrite(&type, sizeof(type), 1, dst_file);
36         if (written != 1)
37                 Fatal("Could not write Chunk header! (ID)");
38         written = fwrite(&size, sizeof(size), 1, dst_file);
39         if (written != 1)
40                 Fatal("Could not write Chunk header (size)!");
41 }
42
43 static bool ReadChunkHeader(FILE *src_file, DocChunkTypes& type, uint32_t& size)
44 {
45         if (fread(&type, sizeof(DocChunkTypes), 1, src_file) != 1)
46                 return false;
47         if (fread(&size, sizeof(uint32_t), 1, src_file) != 1)
48                 return false;
49         return true;
50 }
51
52 void Document::Save(const string & filename)
53 {
54         Debug("Saving document to file \"%s\"...", filename.c_str());
55         FILE * file = fopen(filename.c_str(), "w");
56         if (file == NULL)
57                 Fatal("Couldn't open file \"%s\" - %s", filename.c_str(), strerror(errno));
58
59         size_t written;
60         Debug("Number of objects (%u)...", ObjectCount());
61         WriteChunkHeader(file, CT_NUMOBJS, sizeof(m_count));
62         written = fwrite(&m_count, sizeof(m_count), 1, file);
63         if (written != 1)
64                 Fatal("Failed to write number of objects!");
65
66         Debug("Object types...");
67         WriteChunkHeader(file, CT_OBJTYPES, m_objects.types.size() * sizeof(ObjectType));
68         SaveStructVector<ObjectType>(file, m_objects.types);
69
70         Debug("Object bounds...");
71         WriteChunkHeader(file, CT_OBJBOUNDS, m_objects.bounds.size() * sizeof(Rect));
72         SaveStructVector<Rect>(file, m_objects.bounds);
73
74         Debug("Object data indices...");
75         WriteChunkHeader(file, CT_OBJINDICES, m_objects.data_indices.size() * sizeof(unsigned));
76         SaveStructVector<unsigned>(file, m_objects.data_indices);
77         
78         Debug("Bezier data...");
79         WriteChunkHeader(file, CT_OBJBEZIERS, m_objects.beziers.size() * sizeof(uint8_t));
80         SaveStructVector<Bezier>(file, m_objects.beziers);
81
82         int err = fclose(file);
83         if (err != 0)
84                 Fatal("Failed to close file \"%s\" - %s", filename.c_str(), strerror(err));
85
86         Debug("Successfully saved %u objects to \"%s\"", ObjectCount(), filename.c_str());
87 }
88
89 #ifndef QUADTREE_DISABLED
90
91 void Document::GenBaseQuadtree()
92 {
93         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QTC_UNKNOWN, 0, ObjectCount()});
94         m_quadtree.root_id = 0;
95         GenQuadChild(0, QTC_TOP_LEFT);
96         GenQuadParent(0, QTC_BOTTOM_RIGHT);
97 }
98
99 QuadTreeIndex Document::GenQuadChild(QuadTreeIndex parent, QuadTreeNodeChildren type)
100 {
101         QuadTreeIndex new_index = m_quadtree.nodes.size();
102         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, parent, type, 0, 0});
103
104         m_quadtree.nodes[new_index].object_begin = m_objects.bounds.size();
105         for (unsigned i = m_quadtree.nodes[parent].object_begin; i < m_quadtree.nodes[parent].object_end; ++i)
106         {
107                 if (ContainedInQuadChild(m_objects.bounds[i], type))
108                 {
109                         m_objects.bounds.push_back(TransformToQuadChild(m_objects.bounds[i], type));
110                         m_objects.types.push_back(m_objects.types[i]);
111                         m_objects.data_indices.push_back(m_objects.data_indices[i]);
112                         m_count++;
113                 }
114         }
115         m_quadtree.nodes[new_index].object_end = m_objects.bounds.size();
116         switch (type)
117         {
118                 case QTC_TOP_LEFT:
119                         m_quadtree.nodes[parent].top_left = new_index;
120                         break;
121                 case QTC_TOP_RIGHT:
122                         m_quadtree.nodes[parent].top_right = new_index;
123                         break;
124                 case QTC_BOTTOM_LEFT:
125                         m_quadtree.nodes[parent].bottom_left = new_index;
126                         break;
127                 case QTC_BOTTOM_RIGHT:
128                         m_quadtree.nodes[parent].bottom_right = new_index;
129                         break;
130                 default:
131                         Fatal("Tried to add a QuadTree child of invalid type!");
132         }
133         return new_index;
134 }
135
136 // Reparent a quadtree node, making it the "type" child of a new node.
137 QuadTreeIndex Document::GenQuadParent(QuadTreeIndex child, QuadTreeNodeChildren type)
138 {
139         QuadTreeIndex new_index = m_quadtree.nodes.size();
140         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, -1, QTC_UNKNOWN, 0, 0});
141
142         m_quadtree.nodes[new_index].object_begin = m_objects.bounds.size();
143         for (unsigned i = m_quadtree.nodes[child].object_begin; i < m_quadtree.nodes[child].object_end; ++i)
144         {
145                 m_objects.bounds.push_back(TransformFromQuadChild(m_objects.bounds[i], type));
146                 m_objects.types.push_back(m_objects.types[i]);
147                 m_objects.data_indices.push_back(m_objects.data_indices[i]);
148                 m_count++;
149         }
150         m_quadtree.nodes[new_index].object_end = m_objects.bounds.size();
151         switch (type)
152         {
153                 case QTC_TOP_LEFT:
154                         m_quadtree.nodes[new_index].top_left = child;
155                         break;
156                 case QTC_TOP_RIGHT:
157                         m_quadtree.nodes[new_index].top_right = child;
158                         break;
159                 case QTC_BOTTOM_LEFT:
160                         m_quadtree.nodes[new_index].bottom_left = child;
161                         break;
162                 case QTC_BOTTOM_RIGHT:
163                         m_quadtree.nodes[new_index].bottom_right = child;
164                         break;
165                 default:
166                         Fatal("Tried to add a QuadTree child of invalid type!");
167         }
168         return new_index;
169 }
170
171 #endif
172
173 void Document::Load(const string & filename)
174 {
175         m_objects.bounds.clear();
176         m_count = 0;
177         if (filename == "")
178         {
179                 Debug("Loaded empty document.");
180                 return;
181         }
182         Debug("Loading document from file \"%s\"", filename.c_str());
183         FILE * file = fopen(filename.c_str(), "r");
184         if (file == NULL)
185                 Fatal("Couldn't open file \"%s\"", filename.c_str(), strerror(errno));
186
187         size_t read;
188
189         DocChunkTypes chunk_type;
190         uint32_t chunk_size;
191         while (ReadChunkHeader(file, chunk_type, chunk_size))
192         {
193                 switch(chunk_type)
194                 {
195                 case CT_NUMOBJS:
196                         read = fread(&m_count, sizeof(m_count), 1, file);
197                         if (read != 1)
198                                 Fatal("Failed to read number of objects!");
199                         Debug("Number of objects: %u", ObjectCount());
200                         break;
201                 case CT_OBJTYPES:
202                         Debug("Object types...");
203                         LoadStructVector<ObjectType>(file, chunk_size/sizeof(ObjectType), m_objects.types);
204                         break;
205                 case CT_OBJBOUNDS:
206                         Debug("Object bounds...");
207                         LoadStructVector<Rect>(file, chunk_size/sizeof(Rect), m_objects.bounds);
208                         break;
209                 case CT_OBJINDICES:
210                         Debug("Object data indices...");
211                         LoadStructVector<unsigned>(file, chunk_size/sizeof(unsigned), m_objects.data_indices);
212                         break;
213                 case CT_OBJBEZIERS:
214                         Debug("Bezier data...");
215                         LoadStructVector<Bezier>(file, chunk_size/sizeof(Bezier), m_objects.beziers);
216                         break;
217                 }
218         }
219         Debug("Successfully loaded %u objects from \"%s\"", ObjectCount(), filename.c_str());
220 #ifndef QUADTREE_DISABLED
221         if (m_quadtree.root_id == QUADTREE_EMPTY)
222         {
223                 GenBaseQuadtree();
224         }
225 #endif
226 }
227
228 void Document::Add(ObjectType type, const Rect & bounds, unsigned data_index)
229 {
230         m_objects.types.push_back(type);
231         m_objects.bounds.push_back(bounds);
232         m_objects.data_indices.push_back(data_index);
233         ++m_count; // Why can't we just use the size of types or something?
234 }
235
236 unsigned Document::AddBezierData(const Bezier & bezier)
237 {
238         m_objects.beziers.push_back(bezier);
239         return m_objects.beziers.size()-1;
240 }
241
242
243 void Document::DebugDumpObjects()
244 {
245         Debug("Objects for Document %p are:", this);
246         for (unsigned id = 0; id < ObjectCount(); ++id)
247         {
248                 Debug("%u. \tType: %u\tBounds: %s", id, m_objects.types[id], m_objects.bounds[id].Str().c_str());
249         }
250 }
251
252 bool Document::operator==(const Document & equ) const
253 {
254         return (ObjectCount() == equ.ObjectCount() 
255                 && memcmp(m_objects.bounds.data(), equ.m_objects.bounds.data(), ObjectCount() * sizeof(Rect)) == 0
256                 && memcmp(m_objects.data_indices.data(), equ.m_objects.data_indices.data(), ObjectCount() * sizeof(unsigned)) == 0
257                 && memcmp(m_objects.beziers.data(), equ.m_objects.beziers.data(), m_objects.beziers.size() * sizeof(Bezier)) == 0);
258 }
259
260
261 #include "../contrib/pugixml-1.4/src/pugixml.hpp"
262 #include "../contrib/pugixml-1.4/src/pugixml.cpp"
263
264 void Document::LoadSVG(const string & filename, const Rect & bounds)
265 {
266         using namespace pugi;
267         
268         xml_document doc_xml;
269         ifstream input(filename.c_str(), ios_base::in);
270         xml_parse_result result = doc_xml.load(input);
271         
272         if (!result)
273                 Fatal("Couldn't load \"%s\" - %s", filename.c_str(), result.description());
274                 
275         Debug("Loaded XML - %s", result.description());
276         
277         input.close();
278
279         // Combine all SVG tags into one thing because lazy
280         for (xml_node svg : doc_xml.children("svg"))
281         {
282                 Real width = svg.attribute("width").as_float() * bounds.w;
283                 Real height = svg.attribute("width").as_float() * bounds.h;
284                 
285                 
286                 // Rectangles
287                 Real coords[4];
288                 const char * attrib_names[] = {"x", "y", "width", "height"};
289                 for (pugi::xml_node rect : svg.children("rect"))
290                 {
291                         for (size_t i = 0; i < 4; ++i)
292                                 coords[i] = rect.attribute(attrib_names[i]).as_float();
293                         
294                         bool outline = !(rect.attribute("fill"));
295                         Add(outline?RECT_OUTLINE:RECT_FILLED, Rect(coords[0]/width + bounds.x, coords[1]/height + bounds.y, coords[2]/width, coords[3]/height),0);
296                         Debug("Added rectangle");
297                 }               
298                 
299                 // Circles
300                 for (pugi::xml_node circle : svg.children("circle"))
301                 {
302                         Real cx = circle.attribute("cx").as_float();
303                         Real cy = circle.attribute("cy").as_float();
304                         Real r = circle.attribute("r").as_float();
305                         
306                         Real x = (cx - r)/width + bounds.x; 
307                         Real y = (cy - r)/height + bounds.y; 
308                         Real w = 2*r/width; 
309                         Real h = 2*r/height;
310                         
311                         Rect rect(x,y,w,h);
312                         Add(CIRCLE_FILLED, rect,0);
313                         Debug("Added Circle %s", rect.Str().c_str());
314
315                 }               
316                 
317                 // paths
318                 for (pugi::xml_node path : svg.children("path"))
319                 {
320                         
321                         string d = path.attribute("d").as_string();
322                         Debug("Path data attribute is \"%s\"", d.c_str());
323                         AddPathFromString(d, Rect(bounds.x,bounds.y,width,height));
324                         
325                 }
326         }
327         
328         //Fatal("Done");
329         
330         
331
332 }
333
334 // Behold my amazing tokenizing abilities
335 static string & GetToken(const string & d, string & token, unsigned & i)
336 {
337         token.clear();
338         while (i < d.size() && iswspace(d[i]))
339         {
340                 ++i;
341         }
342         
343         while (i < d.size())
344         {
345                 if (d[i] == ',' || isalpha(d[i]) || iswspace(d[i]))
346                 {
347                         if (token.size() == 0 && !iswspace(d[i]))
348                         {
349                                 token += d[i++];
350                         }
351                         break;  
352                 }
353                 token += d[i++];
354         }
355         Debug("Got token \"%s\"", token.c_str());
356         return token;
357 }
358
359
360 // Fear the wrath of the tokenizing svg data
361 // Seriously this isn't really very DOM-like at all is it?
362 void Document::AddPathFromString(const string & d, const Rect & bounds)
363 {
364         Real x[3] = {0,0,0};
365         Real y[3] = {0,0,0};
366         
367         string token("");
368         string command("m");
369         
370         unsigned i = 0;
371         unsigned prev_i = 0;
372         Real x0;
373         Real y0;
374         bool started = false;
375         while (i < d.size() && GetToken(d, token, i).size() > 0)
376         {
377                 if (isalpha(token[0]))
378                         command = token;
379                 else
380                 {
381                         i = prev_i; // hax
382                         if(command == "")
383                                 command = "l";
384                 }
385                         
386                 if (command == "m")
387                 {
388                         Debug("Construct moveto command");
389                         x[0] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.w;
390                         assert(GetToken(d,token,i) == ",");
391                         y[0] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.h;
392                         if (!started)
393                         {
394                                 x0 = x[0];
395                                 y0 = y[0];
396                                 started = true;
397                         }
398                         Debug("mmoveto %f,%f", Float(x[0]),Float(y[0]));
399                         command = "l";
400                 }
401                 else if (command == "c")
402                 {
403                         Debug("Construct curveto command");
404                         x[0] = strtod(GetToken(d,token,i).c_str(),NULL)/bounds.w;
405                         assert(GetToken(d,token,i) == ",");
406                         y[0] = strtod(GetToken(d,token,i).c_str(),NULL)/bounds.h;
407                         
408                         x[1] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.w;
409                         assert(GetToken(d,token,i) == ",");
410                         y[1] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.h;
411                         
412                         x[2] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.w;
413                         assert(GetToken(d,token,i) == ",");
414                         y[2] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.h;
415                         
416                         unsigned index = AddBezierData(Bezier(x[0],y[0],x[1],y[1],x[2],y[2]));
417                         Add(BEZIER,bounds,index);
418                         
419                         
420                         Debug("[%u] curveto %f,%f %f,%f %f,%f", index, Float(x[0]),Float(y[0]),Float(x[1]),Float(y[1]),Float(x[2]),Float(y[2]));
421                         
422                         x[0] = x[2];
423                         y[0] = y[2];
424
425                         
426                 }
427                 else if (command == "l")
428                 {
429                         Debug("Construct lineto command");
430                 
431                         x[1] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.w;
432                         assert(GetToken(d,token,i) == ",");
433                         y[1] = strtod(GetToken(d,token,i).c_str(),NULL) / bounds.h;
434                         
435                         x[2] = x[1];
436                         y[2] = y[1];
437
438                         Rect segment_bounds(x[0], y[0], x[2] - x[0], y[2] - y[0]);
439                         
440                         unsigned index = AddBezierData(Bezier(x[0],y[0],x[1],y[1],x[2],y[2]));
441                         Add(BEZIER,bounds,index);
442                         
443                         Debug("[%u] lineto %f,%f %f,%f", index, Float(x[0]),Float(y[0]),Float(x[1]),Float(y[1]));
444                         
445                         x[0] = x[2];
446                         y[0] = y[2];
447
448                 }
449                 else if (command == "z")
450                 {
451                         Debug("Construct returnto command");
452                         x[1] = x0;
453                         y[1] = y0;
454                         x[2] = x0;
455                         y[2] = y0;
456                         
457                         unsigned index = AddBezierData(Bezier(x[0],y[0],x[1],y[1],x[2],y[2]));
458                         Add(BEZIER,bounds,index);
459                         
460                         Debug("[%u] returnto %f,%f %f,%f", index, Float(x[0]),Float(y[0]),Float(x[1]),Float(y[1]));
461                         
462                         x[0] = x[2];
463                         y[0] = y[2];
464                         command = "m";
465                 }
466                 else
467                 {
468                         Warn("Unrecognised command \"%s\", set to \"m\"", command.c_str());
469                         command = "m";
470                 }
471                 prev_i = i;
472         }
473 }

UCC git Repository :: git.ucc.asn.au