Totally break Quadtree Béziers.
[ipdf/code.git] / src / document.cpp
1 #include "document.h"
2 #include "bezier.h"
3 #include <cstdio>
4 #include <fstream>
5
6 #include "../contrib/pugixml-1.4/src/pugixml.cpp"
7
8 #include "stb_truetype.h"
9
10 using namespace IPDF;
11 using namespace std;
12
13 //TODO: Make this work for variable sized Reals
14
15 // Loads an std::vector<T> of size num_elements from a file.
16 template<typename T>
17 static void LoadStructVector(FILE *src_file, size_t num_elems, std::vector<T>& dest)
18 {
19         size_t structsread = 0;
20         dest.resize(num_elems);
21         structsread = fread(dest.data(), sizeof(T), num_elems, src_file);
22         if (structsread != num_elems)
23                 Fatal("Only read %u structs (expected %u)!", structsread, num_elems);
24 }
25
26 // Saves an std::vector<T> to a file. Size must be saves separately.
27 template<typename T>
28 static void SaveStructVector(FILE *dst_file, std::vector<T>& src)
29 {
30         size_t written = 0;
31         written = fwrite(src.data(), sizeof(T), src.size(), dst_file);
32         if (written != src.size())
33                 Fatal("Only wrote %u structs (expected %u)!", written, src.size());
34 }
35
36 static void WriteChunkHeader(FILE *dst_file, DocChunkTypes type, uint32_t size)
37 {
38         size_t written = 0;
39         written = fwrite(&type, sizeof(type), 1, dst_file);
40         if (written != 1)
41                 Fatal("Could not write Chunk header! (ID)");
42         written = fwrite(&size, sizeof(size), 1, dst_file);
43         if (written != 1)
44                 Fatal("Could not write Chunk header (size)!");
45 }
46
47 static bool ReadChunkHeader(FILE *src_file, DocChunkTypes& type, uint32_t& size)
48 {
49         if (fread(&type, sizeof(DocChunkTypes), 1, src_file) != 1)
50                 return false;
51         if (fread(&size, sizeof(uint32_t), 1, src_file) != 1)
52                 return false;
53         return true;
54 }
55
56 void Document::Save(const string & filename)
57 {
58         Debug("Saving document to file \"%s\"...", filename.c_str());
59         FILE * file = fopen(filename.c_str(), "w");
60         if (file == NULL)
61                 Fatal("Couldn't open file \"%s\" - %s", filename.c_str(), strerror(errno));
62
63         size_t written;
64         Debug("Number of objects (%u)...", ObjectCount());
65         WriteChunkHeader(file, CT_NUMOBJS, sizeof(m_count));
66         written = fwrite(&m_count, sizeof(m_count), 1, file);
67         if (written != 1)
68                 Fatal("Failed to write number of objects!");
69
70         Debug("Object types...");
71         WriteChunkHeader(file, CT_OBJTYPES, m_objects.types.size() * sizeof(ObjectType));
72         SaveStructVector<ObjectType>(file, m_objects.types);
73
74         Debug("Object bounds...");
75         WriteChunkHeader(file, CT_OBJBOUNDS, m_objects.bounds.size() * sizeof(Rect));
76         SaveStructVector<Rect>(file, m_objects.bounds);
77
78         Debug("Object data indices...");
79         WriteChunkHeader(file, CT_OBJINDICES, m_objects.data_indices.size() * sizeof(unsigned));
80         SaveStructVector<unsigned>(file, m_objects.data_indices);
81         
82         Debug("Bezier data...");
83         WriteChunkHeader(file, CT_OBJBEZIERS, m_objects.beziers.size() * sizeof(uint8_t));
84         SaveStructVector<Bezier>(file, m_objects.beziers);
85
86         int err = fclose(file);
87         if (err != 0)
88                 Fatal("Failed to close file \"%s\" - %s", filename.c_str(), strerror(err));
89
90         Debug("Successfully saved %u objects to \"%s\"", ObjectCount(), filename.c_str());
91 }
92
93 #ifndef QUADTREE_DISABLED
94
95 void Document::GenBaseQuadtree()
96 {
97         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QTC_UNKNOWN, 0, ObjectCount()});
98         m_quadtree.root_id = 0;
99         GenQuadChild(0, QTC_TOP_LEFT);
100 }
101
102 int Document::ClipObjectToQuadChild(int object_id, QuadTreeNodeChildren type)
103 {
104         switch (m_objects.types[object_id])
105         {
106         case RECT_FILLED:
107         case RECT_OUTLINE:
108                 {
109                 Rect obj_bounds = TransformToQuadChild(m_objects.bounds[object_id], type);
110                 if (obj_bounds.x < 0)
111                 {
112                         obj_bounds.w += obj_bounds.x;
113                         obj_bounds.x = 0;
114                 }
115                 if (obj_bounds.y < 0)
116                 {
117                         obj_bounds.h += obj_bounds.y;
118                         obj_bounds.y = 0;
119                 }
120                 if (obj_bounds.x + obj_bounds.w > 1)
121                 {
122                         obj_bounds.w += (1 - (obj_bounds.x + obj_bounds.w));
123                 }
124                 if (obj_bounds.y + obj_bounds.h > 1)
125                 {
126                         obj_bounds.h += (1 - (obj_bounds.y + obj_bounds.h));
127                 }
128                 m_objects.bounds.push_back(obj_bounds);
129                 m_objects.types.push_back(m_objects.types[object_id]);
130                 m_objects.data_indices.push_back(m_objects.data_indices[object_id]);
131                 return 1;
132                 }
133         case BEZIER:
134                 {
135                 Rect child_node_bounds = TransformFromQuadChild({0,0,1,1}, type);
136                 std::vector<Bezier> new_curves = m_objects.beziers[m_objects.data_indices[object_id]].ClipToRectangle(child_node_bounds);
137                 Rect obj_bounds = TransformToQuadChild(m_objects.bounds[object_id], type);
138                 for (size_t i = 0; i < new_curves.size(); ++i)
139                 {
140                         unsigned index = AddBezierData(new_curves[i]);
141                         m_objects.bounds.push_back(obj_bounds);
142                         m_objects.types.push_back(BEZIER);
143                         m_objects.data_indices.push_back(index);
144                 }
145                 return new_curves.size();
146                 }
147         default:
148                 Debug("Adding %s -> %s", m_objects.bounds[object_id].Str().c_str(), TransformToQuadChild(m_objects.bounds[object_id], type).Str().c_str());
149                 m_objects.bounds.push_back(TransformToQuadChild(m_objects.bounds[object_id], type));
150                 m_objects.types.push_back(m_objects.types[object_id]);
151                 m_objects.data_indices.push_back(m_objects.data_indices[object_id]);
152                 return 1;
153         }
154         return 0;
155 }
156 QuadTreeIndex Document::GenQuadChild(QuadTreeIndex parent, QuadTreeNodeChildren type)
157 {
158         QuadTreeIndex new_index = m_quadtree.nodes.size();
159         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, parent, type, 0, 0});
160
161         m_quadtree.nodes[new_index].object_begin = m_objects.bounds.size();
162         for (unsigned i = m_quadtree.nodes[parent].object_begin; i < m_quadtree.nodes[parent].object_end; ++i)
163         {
164                 if (IntersectsQuadChild(m_objects.bounds[i], type))
165                 {
166                         m_count += ClipObjectToQuadChild(i, type);
167                 }
168         }
169         m_quadtree.nodes[new_index].object_end = m_objects.bounds.size();
170         switch (type)
171         {
172                 case QTC_TOP_LEFT:
173                         m_quadtree.nodes[parent].top_left = new_index;
174                         break;
175                 case QTC_TOP_RIGHT:
176                         m_quadtree.nodes[parent].top_right = new_index;
177                         break;
178                 case QTC_BOTTOM_LEFT:
179                         m_quadtree.nodes[parent].bottom_left = new_index;
180                         break;
181                 case QTC_BOTTOM_RIGHT:
182                         m_quadtree.nodes[parent].bottom_right = new_index;
183                         break;
184                 default:
185                         Fatal("Tried to add a QuadTree child of invalid type!");
186         }
187         return new_index;
188 }
189
190 // Reparent a quadtree node, making it the "type" child of a new node.
191 QuadTreeIndex Document::GenQuadParent(QuadTreeIndex child, QuadTreeNodeChildren type)
192 {
193         QuadTreeIndex new_index = m_quadtree.nodes.size();
194         m_quadtree.nodes.push_back(QuadTreeNode{QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, QUADTREE_EMPTY, -1, QTC_UNKNOWN, 0, 0});
195
196         m_quadtree.nodes[new_index].object_begin = m_objects.bounds.size();
197         for (unsigned i = m_quadtree.nodes[child].object_begin; i < m_quadtree.nodes[child].object_end; ++i)
198         {
199                 m_objects.bounds.push_back(TransformFromQuadChild(m_objects.bounds[i], type));
200                 m_objects.types.push_back(m_objects.types[i]);
201                 m_objects.data_indices.push_back(m_objects.data_indices[i]);
202                 m_count++;
203         }
204         m_quadtree.nodes[new_index].object_end = m_objects.bounds.size();
205         switch (type)
206         {
207                 case QTC_TOP_LEFT:
208                         m_quadtree.nodes[new_index].top_left = child;
209                         break;
210                 case QTC_TOP_RIGHT:
211                         m_quadtree.nodes[new_index].top_right = child;
212                         break;
213                 case QTC_BOTTOM_LEFT:
214                         m_quadtree.nodes[new_index].bottom_left = child;
215                         break;
216                 case QTC_BOTTOM_RIGHT:
217                         m_quadtree.nodes[new_index].bottom_right = child;
218                         break;
219                 default:
220                         Fatal("Tried to add a QuadTree child of invalid type!");
221         }
222         return new_index;
223 }
224
225 #endif
226
227 void Document::Load(const string & filename)
228 {
229         m_objects.bounds.clear();
230         m_count = 0;
231         if (filename == "")
232         {
233                 Debug("Loaded empty document.");
234                 return;
235         }
236         Debug("Loading document from file \"%s\"", filename.c_str());
237         FILE * file = fopen(filename.c_str(), "r");
238         if (file == NULL)
239                 Fatal("Couldn't open file \"%s\"", filename.c_str(), strerror(errno));
240
241         size_t read;
242
243         DocChunkTypes chunk_type;
244         uint32_t chunk_size;
245         while (ReadChunkHeader(file, chunk_type, chunk_size))
246         {
247                 switch(chunk_type)
248                 {
249                 case CT_NUMOBJS:
250                         read = fread(&m_count, sizeof(m_count), 1, file);
251                         if (read != 1)
252                                 Fatal("Failed to read number of objects!");
253                         Debug("Number of objects: %u", ObjectCount());
254                         break;
255                 case CT_OBJTYPES:
256                         Debug("Object types...");
257                         LoadStructVector<ObjectType>(file, chunk_size/sizeof(ObjectType), m_objects.types);
258                         break;
259                 case CT_OBJBOUNDS:
260                         Debug("Object bounds...");
261                         LoadStructVector<Rect>(file, chunk_size/sizeof(Rect), m_objects.bounds);
262                         break;
263                 case CT_OBJINDICES:
264                         Debug("Object data indices...");
265                         LoadStructVector<unsigned>(file, chunk_size/sizeof(unsigned), m_objects.data_indices);
266                         break;
267                 case CT_OBJBEZIERS:
268                         Debug("Bezier data...");
269                         LoadStructVector<Bezier>(file, chunk_size/sizeof(Bezier), m_objects.beziers);
270                         break;
271                         
272                 case CT_OBJGROUPS:
273                         Debug("Group data...");
274                         Warn("Not handled because lazy");
275                         break;
276                 }
277         }
278         Debug("Successfully loaded %u objects from \"%s\"", ObjectCount(), filename.c_str());
279 #ifndef QUADTREE_DISABLED
280         if (m_quadtree.root_id == QUADTREE_EMPTY)
281         {
282                 GenBaseQuadtree();
283         }
284 #endif
285 }
286
287 unsigned Document::AddGroup(unsigned start_index, unsigned end_index)
288 {
289         Real xmin = 0; Real ymin = 0; 
290         Real xmax = 0; Real ymax = 0;
291         
292         for (unsigned i = start_index; i <= end_index; ++i)
293         {
294                 Rect & objb = m_objects.bounds[i];
295                 
296                 if (i == start_index || objb.x < xmin)
297                         xmin = objb.x;
298                 if (i == start_index || (objb.x+objb.w) > xmax)
299                         xmax = (objb.x+objb.w);
300                         
301                 if (i == start_index || objb.y < ymin)
302                         ymin = objb.y;
303                 if (i == start_index || (objb.y+objb.h) > ymax)
304                         ymax = (objb.y+objb.h);
305         }
306         
307         Rect bounds(xmin,ymin, xmax-xmin, ymax-ymin);
308         unsigned result = Add(GROUP, bounds,0);
309         m_objects.groups[m_count-1].first = start_index;
310         m_objects.groups[m_count-1].second = end_index;
311         return result;
312 }
313
314 /**
315  * Add a Bezier using Absolute coords
316  */
317 unsigned Document::AddBezier(const Bezier & bezier)
318 {
319         Rect bounds = bezier.SolveBounds();
320         Bezier data = bezier.ToRelative(bounds); // Relative
321         unsigned index = AddBezierData(data);
322         return Add(BEZIER, bounds, index);
323 }
324
325 unsigned Document::Add(ObjectType type, const Rect & bounds, unsigned data_index)
326 {
327         m_objects.types.push_back(type);
328         m_objects.bounds.push_back(bounds);
329         m_objects.data_indices.push_back(data_index);
330         m_objects.groups.push_back(pair<unsigned, unsigned>(data_index, data_index));
331         return (m_count++); // Why can't we just use the size of types or something?
332 }
333
334 unsigned Document::AddBezierData(const Bezier & bezier)
335 {
336         m_objects.beziers.push_back(bezier);
337         return m_objects.beziers.size()-1;
338 }
339
340
341 void Document::DebugDumpObjects()
342 {
343         Debug("Objects for Document %p are:", this);
344         for (unsigned id = 0; id < ObjectCount(); ++id)
345         {
346                 Debug("%u. \tType: %u\tBounds: %s", id, m_objects.types[id], m_objects.bounds[id].Str().c_str());
347         }
348 }
349
350 bool Document::operator==(const Document & equ) const
351 {
352         return (ObjectCount() == equ.ObjectCount() 
353                 && memcmp(m_objects.bounds.data(), equ.m_objects.bounds.data(), ObjectCount() * sizeof(Rect)) == 0
354                 && memcmp(m_objects.data_indices.data(), equ.m_objects.data_indices.data(), ObjectCount() * sizeof(unsigned)) == 0
355                 && memcmp(m_objects.beziers.data(), equ.m_objects.beziers.data(), m_objects.beziers.size() * sizeof(Bezier)) == 0);
356 }
357
358
359
360 // Behold my amazing tokenizing abilities
361 static string & GetToken(const string & d, string & token, unsigned & i, const string & delims = "()[],{}<>;:=")
362 {
363         token.clear();
364         while (i < d.size() && iswspace(d[i]))
365         {
366                 ++i;
367         }
368         
369         while (i < d.size())
370         {
371                 if (iswspace(d[i]) || strchr(delims.c_str(),d[i]) != NULL)
372                 {
373                         if (token.size() == 0 && !iswspace(d[i]))
374                         {
375                                 token += d[i++];
376                         }
377                         break;  
378                 }
379                 token += d[i++];
380         }
381         //Debug("Got token \"%s\"", token.c_str());
382         return token;
383 }
384
385 static void GetXYPair(const string & d, Real & x, Real & y, unsigned & i,const string & delims = "()[],{}<>;:=")
386 {
387         string token("");
388         while (GetToken(d, token, i, delims) == ",");
389         x = strtod(token.c_str(),NULL);
390         if (GetToken(d, token, i, delims) != ",")
391         {
392                 Fatal("Expected \",\" seperating x,y pair");
393         }
394         y = strtod(GetToken(d, token, i, delims).c_str(),NULL);
395 }
396
397 static void TransformXYPair(Real & x, Real & y, const SVGMatrix & transform)
398 {
399         Real x0(x);
400         x = transform.a * x + transform.c * y + transform.e;
401         y = transform.b * x0 + transform.d * y + transform.f;
402 }
403
404 void Document::ParseSVGTransform(const string & s, SVGMatrix & transform)
405 {
406         //Debug("Parsing transform %s", s.c_str());
407         string token;
408         string command;
409         unsigned i = 0;
410         
411         while (i < s.size())
412         {
413                 GetToken(s, command, i);
414                 if (command == "," || command == "" || command == ":")
415                 {
416                         if (i < s.size())
417                                 GetToken(s, command, i);
418                         else
419                                 return;
420                 }
421                 //Debug("Token is \"%s\"", command.c_str());
422         
423                 SVGMatrix delta = {1,0,0,0,1,0};
424         
425         
426                 assert(GetToken(s,token, i) == "(");
427                 if (command == "translate")
428                 {
429                         GetXYPair(s, delta.e, delta.f, i);
430                         assert(GetToken(s,token, i) == ")");    
431                 }
432                 else if (command == "matrix")
433                 {
434                         GetXYPair(s, delta.a, delta.b,i);
435                         GetXYPair(s, delta.c, delta.d,i);
436                         GetXYPair(s, delta.e, delta.f,i);
437                         assert(GetToken(s,token, i) == ")");    
438                 }
439                 else if (command == "scale")
440                 {
441                         delta.a = (strtod(GetToken(s,token,i).c_str(), NULL));
442                         GetToken(s, token, i);
443                         if (token == ",")
444                         {
445                                 delta.d = (strtod(GetToken(s,token,i).c_str(), NULL));
446                                 assert(GetToken(s, token, i) == ")");
447                         }
448                         else
449                         {
450                                 delta.d = delta.a;
451                                 assert(token == ")");
452                         }
453                         
454                 }
455                 else
456                 {
457                         Warn("Unrecognised transform \"%s\", using identity", command.c_str());
458                 }
459         
460                 //Debug("Old transform is {%f,%f,%f,%f,%f,%f}", transform.a, transform.b, transform.c, transform.d,transform.e,transform.f);
461                 //Debug("Delta transform is {%f,%f,%f,%f,%f,%f}", delta.a, delta.b, delta.c, delta.d,delta.e,delta.f);
462         
463                 SVGMatrix old(transform);
464                 transform.a = old.a * delta.a + old.c * delta.b;
465                 transform.c = old.a * delta.c + old.c * delta.d;
466                 transform.e = old.a * delta.e + old.c * delta.f + old.e;
467         
468                 transform.b = old.b * delta.a + old.d * delta.b;
469                 transform.d = old.b * delta.c + old.d * delta.d;
470                 transform.f = old.b * delta.e + old.d * delta.f + old.f;
471         
472                 //Debug("New transform is {%f,%f,%f,%f,%f,%f}", transform.a, transform.b, transform.c, transform.d,transform.e,transform.f);
473         }
474 }
475
476 void Document::ParseSVGNode(pugi::xml_node & root, SVGMatrix & parent_transform)
477 {
478         //Debug("Parse node <%s>", root.name());
479
480                 
481         for (pugi::xml_node child = root.first_child(); child; child = child.next_sibling())
482         {
483                 SVGMatrix transform(parent_transform);  
484                 pugi::xml_attribute attrib_trans = child.attribute("transform");
485                 if (!attrib_trans.empty())
486                 {
487                         ParseSVGTransform(attrib_trans.as_string(), transform);
488                 }
489                 
490                 if (strcmp(child.name(), "svg") == 0 || strcmp(child.name(),"g") == 0
491                         || strcmp(child.name(), "group") == 0)
492                 {
493                         
494                         ParseSVGNode(child, transform);
495                         continue;
496                 }
497                 else if (strcmp(child.name(), "path") == 0)
498                 {
499                         string d = child.attribute("d").as_string();
500                         Debug("Path data attribute is \"%s\"", d.c_str());
501                         pair<unsigned, unsigned> range = ParseSVGPathData(d, transform);
502                         AddGroup(range.first, range.second);
503                         
504                 }
505                 else if (strcmp(child.name(), "line") == 0)
506                 {
507                         Real x0(child.attribute("x1").as_float());
508                         Real y0(child.attribute("y1").as_float());
509                         Real x1(child.attribute("x2").as_float());
510                         Real y1(child.attribute("y2").as_float());
511                         TransformXYPair(x0,y0,transform);
512                         TransformXYPair(x1,y1,transform);
513                         AddBezier(Bezier(x0,y0,x1,y1,x1,y1,x1,y1));
514                 }
515                 else if (strcmp(child.name(), "rect") == 0)
516                 {
517                         Real coords[4];
518                         const char * attrib_names[] = {"x", "y", "width", "height"};
519                         for (size_t i = 0; i < 4; ++i)
520                                 coords[i] = child.attribute(attrib_names[i]).as_float();
521                         
522                         Real x2(coords[0]+coords[2]);
523                         Real y2(coords[1]+coords[3]);
524                         TransformXYPair(coords[0],coords[1],transform); // x, y, transform
525                         TransformXYPair(x2,y2,transform);
526                         coords[2] = x2 - coords[0];
527                         coords[3] = y2 - coords[1];
528                         
529                         bool outline = !(child.attribute("fill") && strcmp(child.attribute("fill").as_string(),"none") != 0);
530                         Add(outline?RECT_OUTLINE:RECT_FILLED, Rect(coords[0], coords[1], coords[2], coords[3]),0);
531                 }
532                 else if (strcmp(child.name(), "circle") == 0)
533                 {
534                         Real cx = child.attribute("cx").as_float();
535                         Real cy = child.attribute("cy").as_float();
536                         Real r = child.attribute("r").as_float();
537                         
538                         Real x = (cx - r);
539                         Real y = (cy - r);
540                         TransformXYPair(x,y,transform);
541                         Real w = Real(2)*r*transform.a; // width scales
542                         Real h = Real(2)*r*transform.d; // height scales
543                         
544                         
545                         Rect rect(x,y,w,h);
546                         Add(CIRCLE_FILLED, rect,0);
547                         Debug("Added Circle %s", rect.Str().c_str());                   
548                 }
549                 else if (strcmp(child.name(), "text") == 0)
550                 {
551                         Real x = child.attribute("x").as_float();
552                         Real y = child.attribute("y").as_float();
553                         TransformXYPair(x,y,transform);
554                         Debug("Add text \"%s\"", child.child_value());
555                         AddText(child.child_value(), 0.05, x, y);
556                 }
557         }
558 }
559
560 /**
561  * Parse an SVG string into a rectangle
562  */
563 void Document::ParseSVG(const string & input, const Rect & bounds)
564 {
565         using namespace pugi;
566         
567         xml_document doc_xml;
568         xml_parse_result result = doc_xml.load(input.c_str());
569         
570         if (!result)
571                 Error("Couldn't parse SVG input - %s", result.description());
572                 
573         Debug("Loaded XML - %s", result.description());
574         SVGMatrix transform = {bounds.w, 0,bounds.x, 0,bounds.h,bounds.y};
575         ParseSVGNode(doc_xml, transform);
576 }
577
578 /**
579  * Load an SVG into a rectangle
580  */
581 void Document::LoadSVG(const string & filename, const Rect & bounds)
582 {
583         using namespace pugi;
584         
585         xml_document doc_xml;
586         ifstream input(filename.c_str(), ios_base::in);
587         xml_parse_result result = doc_xml.load(input);
588         
589         if (!result)
590                 Error("Couldn't load \"%s\" - %s", filename.c_str(), result.description());
591                 
592         Debug("Loaded XML - %s", result.description());
593         
594         input.close();
595                                                 // a c e, b d f
596         SVGMatrix transform = {bounds.w, 0,bounds.x, 0,bounds.h,bounds.y};
597         ParseSVGNode(doc_xml, transform);
598 }
599
600
601
602 // Fear the wrath of the tokenizing svg data
603 // Seriously this isn't really very DOM-like at all is it?
604 pair<unsigned, unsigned> Document::ParseSVGPathData(const string & d, const SVGMatrix & transform)
605 {
606         Real x[4] = {0,0,0,0};
607         Real y[4] = {0,0,0,0};
608         
609         string token("");
610         string command("m");
611         
612         Real x0(0);
613         Real y0(0);
614         
615         unsigned i = 0;
616         unsigned prev_i = 0;
617         
618         bool start = false;
619         
620
621         static string delims("()[],{}<>;:=LlHhVvmMqQzZcC");
622
623         pair<unsigned, unsigned> range(m_count, m_count);
624         
625         while (i < d.size() && GetToken(d, token, i, delims).size() > 0)
626         {
627                 if (isalpha(token[0]))
628                         command = token;
629                 else
630                 {
631                         i = prev_i; // hax
632                         if(command == "")
633                                 command = "L";
634                 }
635                 
636                 bool relative = islower(command[0]);
637                         
638                 if (command == "m" || command == "M")
639                 {
640                         //Debug("Construct moveto command");
641                         Real dx = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
642                         assert(GetToken(d,token,i,delims) == ",");
643                         Real dy = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
644                         
645                         x[0] = (relative) ? x[0] + dx : dx;
646                         y[0] = (relative) ? y[0] + dy : dy;
647                         
648                         x0 = x[0];
649                         y0 = y[0];
650                         //Debug("mmoveto %f,%f", Float(x[0]),Float(y[0]));
651                         command = (command == "m") ? "l" : "L";
652                 }
653                 else if (command == "c" || command == "C" || command == "q" || command == "Q")
654                 {
655                         //Debug("Construct curveto command");
656                         Real dx = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
657                         assert(GetToken(d,token,i,delims) == ",");
658                         Real dy = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
659                         
660                         x[1] = (relative) ? x[0] + dx : dx;
661                         y[1] = (relative) ? y[0] + dy : dy;
662                         
663                         dx = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
664                         assert(GetToken(d,token,i,delims) == ",");
665                         dy = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
666                         
667                         x[2] = (relative) ? x[0] + dx : dx;
668                         y[2] = (relative) ? y[0] + dy : dy;
669                         
670                         if (command != "q" && command != "Q")
671                         {
672                                 dx = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
673                                 assert(GetToken(d,token,i,delims) == ",");
674                                 dy = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
675                                 x[3] = (relative) ? x[0] + dx : dx;
676                                 y[3] = (relative) ? y[0] + dy : dy;
677                         }
678                         else
679                         {
680                                 x[3] = x[2];
681                                 y[3] = y[2];
682                                 Real old_x1(x[1]), old_y1(y[1]);
683                                 x[1] = x[0] + Real(2) * (old_x1 - x[0])/ Real(3);
684                                 y[1] = y[0] + Real(2) * (old_y1 - y[0])/ Real(3);
685                                 x[2] = x[3] + Real(2) * (old_x1 - x[3])/ Real(3);
686                                 y[2] = y[3] + Real(2) * (old_y1 - y[3])/ Real(3);
687                         }
688                         
689                         Real x3(x[3]);
690                         Real y3(y[3]);
691                         for (int j = 0; j < 4; ++j)
692                                 TransformXYPair(x[j],y[j], transform);
693
694                         range.second = AddBezier(Bezier(x[0],y[0],x[1],y[1],x[2],y[2],x[3],y[3]));
695                         
696                         //Debug("[%u] curveto %f,%f %f,%f %f,%f", index, Float(x[1]),Float(y[1]),Float(x[2]),Float(y[2]),Float(x[3]),Float(y[3]));
697                         
698                         x[0] = x3;
699                         y[0] = y3;
700
701                         
702                 }
703                 else if (command == "l" || command == "L" || command == "h" || command == "H" || command == "v" || command == "V")
704                 {
705                         Debug("Construct lineto command, relative %d", relative);
706                 
707                         Real dx = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
708                         Real dy;
709                         if (command == "l" || command == "L")
710                         {
711                                 assert(GetToken(d,token,i,delims) == ",");
712                                 dy = Real(strtod(GetToken(d,token,i,delims).c_str(),NULL));
713                         }
714                         else if (command == "v" || command == "V")
715                         {
716                                 swap(dx,dy);
717                         }
718                         
719                         x[1] = (relative) ? x[0] + dx : dx;
720                         y[1] = (relative) ? y[0] + dy : dy;
721                         if (command == "v" || command == "V")
722                         {
723                                 x[1] = x[0];
724                         }
725                         else if (command == "h" || command == "H")
726                         {
727                                 y[1] = y[0];
728                         }
729                         
730                         Real x1(x[1]);
731                         Real y1(y[1]);
732                         
733                         TransformXYPair(x[0],y[0],transform);
734                         TransformXYPair(x[1],y[1],transform);
735
736
737                         range.second = AddBezier(Bezier(x[0],y[0],x[1],y[1],x[1],y[1],x[1],y[1]));
738                         
739                         //Debug("[%u] lineto %f,%f %f,%f", index, Float(x[0]),Float(y[0]),Float(x[1]),Float(y[1]));
740                         
741                         x[0] = x1;
742                         y[0] = y1;
743
744                 }
745                 else if (command == "z" || command == "Z")
746                 {
747                         //Debug("Construct returnto command");
748                         x[1] = x0;
749                         y[1] = y0;
750                         x[2] = x0;
751                         y[2] = y0;
752                         x[3] = x0;
753                         y[3] = y0;
754                         
755                         Real x3(x[3]);
756                         Real y3(y[3]);
757                         for (int j = 0; j < 4; ++j)
758                                 TransformXYPair(x[j],y[j], transform);
759
760                         range.second = AddBezier(Bezier(x[0],y[0],x[1],y[1],x[2],y[2],x[3],y[3]));
761                         //Debug("[%u] returnto %f,%f %f,%f", index, Float(x[0]),Float(y[0]),Float(x[1]),Float(y[1]));
762                         
763                         x[0] = x3;
764                         y[0] = y3;
765                         command = "m";
766                 }
767                 else
768                 {
769                         Warn("Unrecognised command \"%s\", set to \"m\"", command.c_str());
770                         command = "m";
771                 }
772                 
773                 if (!start)
774                 {
775                         x0 = x[0];
776                         y0 = y[0];
777                         start = true;
778                 }
779                 prev_i = i;
780         }
781         return range;
782 }
783
784 void Document::SetFont(const string & font_filename)
785 {
786         if (m_font_data != NULL)
787         {
788                 free(m_font_data);
789         }
790         
791         FILE *font_file = fopen(font_filename.c_str(), "rb");
792         fseek(font_file, 0, SEEK_END);
793         size_t font_file_size = ftell(font_file);
794         fseek(font_file, 0, SEEK_SET);
795         m_font_data = (unsigned char*)malloc(font_file_size);
796         size_t read = fread(m_font_data, 1, font_file_size, font_file);
797         if (read != font_file_size)
798         {
799                 Fatal("Failed to read font data from \"%s\" - Read %u bytes expected %u - %s", font_filename.c_str(), read, font_file_size, strerror(errno));
800         }
801         fclose(font_file);
802         stbtt_InitFont(&m_font, m_font_data, 0);
803 }
804
805 void Document::AddText(const string & text, Real scale, Real x, Real y)
806 {
807         if (m_font_data == NULL)
808         {
809                 Warn("No font loaded");
810                 return;
811         }
812                 
813         Real x0(x);
814         //Real y0(y);
815         int ascent = 0, descent = 0, line_gap = 0;
816         stbtt_GetFontVMetrics(&m_font, &ascent, &descent, &line_gap);
817         float font_scale = scale / (float)(ascent - descent);
818         Real y_advance = Real(font_scale) * Real(ascent - descent + line_gap);
819         for (unsigned i = 0; i < text.size(); ++i)
820         {
821                 if (text[i] == '\n')
822                 {
823                         y += y_advance;
824                         x = x0;
825                 }
826                 if (!isprint(text[i]))
827                         continue;
828                         
829                 int advance_width = 0, left_side_bearing = 0, kerning = 0;
830                 stbtt_GetCodepointHMetrics(&m_font, text[i], &advance_width, &left_side_bearing);
831                 if (i >= 1)
832                 {
833                         kerning = stbtt_GetCodepointKernAdvance(&m_font, text[i-1], text[i]);
834                 }
835                 x += Real(font_scale) * Real(kerning);
836                 AddFontGlyphAtPoint(&m_font, text[i], font_scale, x, y);
837                 x += Real(font_scale) * Real(advance_width);
838         }
839 }
840
841 void Document::AddFontGlyphAtPoint(stbtt_fontinfo *font, int character, Real scale, Real x, Real y)
842 {
843         int glyph_index = stbtt_FindGlyphIndex(font, character);
844
845         // Check if there is actully a glyph to render.
846         if (stbtt_IsGlyphEmpty(font, glyph_index))
847         {
848                 return;
849         }
850
851         stbtt_vertex *instructions;
852         int num_instructions = stbtt_GetGlyphShape(font, glyph_index, &instructions);
853
854         Real current_x(0), current_y(0);
855         unsigned start_index = m_count;
856         unsigned end_index = m_count;
857         for (int i = 0; i < num_instructions; ++i)
858         {
859                 // TTF uses 16-bit signed ints for coordinates:
860                 // with the y-axis inverted compared to us.
861                 // Convert and scale any data.
862                 Real inst_x = Real(instructions[i].x)*scale;
863                 Real inst_y = Real(instructions[i].y)*-scale;
864                 Real inst_cx = Real(instructions[i].cx)*scale;
865                 Real inst_cy = Real(instructions[i].cy)*-scale;
866                 Real old_x(current_x), old_y(current_y);
867                 current_x = inst_x;
868                 current_y = inst_y;
869                 
870                 switch(instructions[i].type)
871                 {
872                 // Move To
873                 case STBTT_vmove:
874                         break;
875                 // Line To
876                 case STBTT_vline:
877                         end_index = AddBezier(Bezier(old_x + x, old_y + y, old_x + x, old_y + y, current_x + x, current_y + y, current_x + x, current_y + y));
878                         break;
879                 // Quadratic Bezier To:
880                 case STBTT_vcurve:
881                         // Quadratic -> Cubic:
882                         // - Endpoints are the same.
883                         // - cubic1 = quad0+(2/3)*(quad1-quad0)
884                         // - cubic2 = quad2+(2/3)*(quad1-quad2)
885                         end_index = AddBezier(Bezier(old_x + x, old_y + y, old_x + Real(2)*(inst_cx-old_x)/Real(3) + x, old_y + Real(2)*(inst_cy-old_y)/Real(3) + y,
886                                                 current_x + Real(2)*(inst_cx-current_x)/Real(3) + x, current_y + Real(2)*(inst_cy-current_y)/Real(3) + y, current_x + x, current_y + y));
887                         break;
888                 }
889         }
890         
891         if (start_index < m_count && end_index < m_count)
892         {
893                 AddGroup(start_index, end_index);
894         }
895         Debug("Added Glyph \"%c\" at %f %f, scale %f", (char)character, Float(x), Float(y), Float(scale));
896
897         stbtt_FreeShape(font, instructions);
898 }

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