/* * Copyright (c) 2013-14 Mikko Mononen memon@inside.org * * This software is provided 'as-is', without any express or implied * warranty. In no event will the authors be held liable for any damages * arising from the use of this software. * * Permission is granted to anyone to use this software for any purpose, * including commercial applications, and to alter it and redistribute it * freely, subject to the following restrictions: * * 1. The origin of this software must not be misrepresented; you must not * claim that you wrote the original software. If you use this software * in a product, an acknowledgment in the product documentation would be * appreciated but is not required. * 2. Altered source versions must be plainly marked as such, and must not be * misrepresented as being the original software. * 3. This notice may not be removed or altered from any source distribution. * * The polygon rasterization is heavily based on stb_truetype rasterizer * by Sean Barrett - http://nothings.org/ * */ /* Example Usage: // Load SVG struct SNVGImage* image = nsvgParseFromFile("test.svg."); // Create rasterizer (can be used to render multiple images). struct NSVGrasterizer* rast = nsvgCreateRasterizer(); // Allocate memory for image UINT8* img = malloc(w*h*4); // Rasterize scaleX = width_to_see / design_width nsvgRasterize(rast, image, 0,0, scaleX, scaleY, img, w, h, w*4); */ #include "nanosvg.h" #include "FloatLib.h" #include "XImage.h" #include "../Platform/Utils.h" #ifndef DEBUG_ALL #define DEBUG_SVG 1 #else #define DEBUG_SVG DEBUG_ALL #endif #if DEBUG_SVG == 0 #define DBG(...) #else #define DBG(...) DebugLog(DEBUG_SVG, __VA_ARGS__) //#define DEBUG_TRACE #endif #define pow(x,n) PowF(x,n) #define sqrtf(x) SqrtF(x) #define sinf(x) SinF(x) #define cosf(x) CosF(x) #define tanf(x) TanF(x) #define ceilf(x) CeilF(x) #define floorf(x) FloorF(x) #define fmodf(x,y) ModF(x,y) #define acosf(x) AcosF(x) #define atan2f(y,x) Atan2F(y,x) #define fabsf(x) FabsF(x) static void renderShape(NSVGrasterizer* r, NSVGshape* shape, float *xform, float min_scale); void nsvg_qsort(NSVGedge* Array, int Low, int High) { int i = Low, j = High; NSVGedge Temp; int Imed = (Low + High) / 2; // Central element, just pointer float med = Array[Imed].y0; // Sort around center while (i <= j) { while (Array[i].y0 < med) i++; while (Array[j].y0 > med) j--; // Change if (i <= j) { memcpy(&Temp, &Array[i], sizeof(NSVGedge)); memcpy(&Array[i++], &Array[j], sizeof(NSVGedge)); memcpy(&Array[j--], &Temp, sizeof(NSVGedge)); } } // Recursion if (j > Low) nsvg_qsort(Array, Low, j); if (High > i) nsvg_qsort(Array, i, High); } void nsvg_qsort(void* Array, int Num, INTN Size, int (*compare)(const void* a, const void* b)) { // QuickSort(Array, 0, Num - 1, Size, compare); nsvg_qsort((NSVGedge*)Array, 0, Num - 1); } //caller is responsible for free memory NSVGrasterizer* nsvg__createRasterizer() { NSVGrasterizer* r = (NSVGrasterizer*)AllocateZeroPool(sizeof(NSVGrasterizer)); if (r == NULL) return NULL; r->tessTol = 0.1f; //0.25f; r->distTol = 0.01f; r->stencilList = NULL; return r; } void nsvg__deleteRasterizer(NSVGrasterizer* r) { NSVGmemPage* p; if (r == NULL) return; p = r->pages; while (p != NULL) { NSVGmemPage* next = p->next; FreePool(p); p = next; } if (r->edges) FreePool(r->edges); if (r->points) FreePool(r->points); if (r->points2) FreePool(r->points2); if (r->scanline) FreePool(r->scanline); if (r->stencil) FreePool(r->stencil); NSVGstencil* s = r->stencilList; while ( s != NULL) { NSVGstencil* next = s->next; if (s->square) FreePool(s->square); FreePool(s); s = next; } FreePool(r); } static NSVGmemPage* nsvg__nextPage(NSVGrasterizer* r, NSVGmemPage* cur) { NSVGmemPage *newp; // If using existing chain, return the next page in chain if (cur != NULL && cur->next != NULL) { return cur->next; } // Alloc new page newp = (NSVGmemPage*)AllocateZeroPool(sizeof(NSVGmemPage)); if (newp == NULL) return NULL; // Add to linked list if (cur != NULL) cur->next = newp; else r->pages = newp; return newp; } static void nsvg__resetPool(NSVGrasterizer* r) { NSVGmemPage* p = r->pages; while (p != NULL) { p->size = 0; p = p->next; } r->curpage = r->pages; } static UINT8* nsvgrast__alloc(NSVGrasterizer* r, int size) { UINT8* buf; if (size > NSVG__MEMPAGE_SIZE) return NULL; if (r->curpage == NULL || r->curpage->size+size > NSVG__MEMPAGE_SIZE) { r->curpage = nsvg__nextPage(r, r->curpage); } buf = &r->curpage->mem[r->curpage->size]; r->curpage->size += size; return buf; } static int nsvg__ptEquals(NSVGpoint* pt1, NSVGpoint* pt2, float tol) { float dx = pt2->x - pt1->x; float dy = pt2->y - pt1->y; return SqrF(dx) + SqrF(dy) < SqrF(tol); } // t is a matrix xform static void nsvg__addPathPoint(NSVGrasterizer* r, NSVGpoint* pt, float* t, int flags) { NSVGpoint* pt1; NSVGpoint pt2; if (!t) { pt2 = *pt; } else { pt2.x = pt->x*t[0] + pt->y*t[2] + t[4]; pt2.y = pt->x*t[1] + pt->y*t[3] + t[5]; } if (r->npoints > 0) { pt1 = &r->points[r->npoints-1]; if (nsvg__ptEquals(pt1, &pt2, r->distTol)) { r->points[r->npoints-1].flags |= (UINT8)flags; return; } } if (r->npoints+1 > r->cpoints) { int OldSize = r->cpoints * sizeof(NSVGpoint); r->cpoints = r->cpoints > 0 ? r->cpoints * 2 : 64; if (OldSize == 0) { r->points = (NSVGpoint*)AllocatePool(64 * sizeof(NSVGpoint)); } else { r->points = (NSVGpoint*)ReallocatePool(OldSize, sizeof(NSVGpoint) * r->cpoints, r->points); } if (r->points == NULL) return; } pt1 = &r->points[r->npoints]; pt1->x = pt2.x; pt1->y = pt2.y; pt1->flags = (UINT8)flags; r->npoints++; } static void nsvg__appendPathPoint(NSVGrasterizer* r, NSVGpoint* pt) { #ifdef DEBUG_TRACE DBG("nsvg__appendPathPoint\n"); #endif if (r->npoints+1 > r->cpoints) { int OldSize = r->cpoints * sizeof(NSVGpoint); r->cpoints = r->cpoints > 0 ? r->cpoints * 2 : 64; if (OldSize == 0) { r->points = (NSVGpoint*)AllocatePool(64 * sizeof(NSVGpoint)); } else r->points = (NSVGpoint*)ReallocatePool(OldSize, sizeof(NSVGpoint) * r->cpoints, r->points); if (r->points == NULL) return; } r->points[r->npoints] = *pt; r->npoints++; } static void nsvg__duplicatePoints(NSVGrasterizer* r) { #ifdef DEBUG_TRACE DBG("nsvg__duplicatePoints\n"); #endif if (r->npoints > r->cpoints2) { int OldSize = r->cpoints2 * sizeof(NSVGpoint); r->cpoints2 = r->npoints; if (OldSize == 0) { r->points2 = (NSVGpoint*)AllocatePool(r->npoints * sizeof(NSVGpoint)); } else r->points2 = (NSVGpoint*)ReallocatePool(OldSize, sizeof(NSVGpoint) * r->cpoints2, r->points2); if (r->points2 == NULL) return; } if (r->npoints) { memcpy(r->points2, r->points, sizeof(NSVGpoint) * r->npoints); } r->npoints2 = r->npoints; } static void nsvg__addEdge(NSVGrasterizer* r, float x0, float y0, float x1, float y1) { #ifdef DEBUG_TRACE DBG("nsvg__addEdge\n"); #endif NSVGedge* e; // Skip horizontal edges if (y0 == y1) return; // DBG("nedges=%d cedges=%d\n", r->nedges, r->cedges); if (r->nedges+1 > r->cedges) { int OldSize = r->cedges * sizeof(NSVGedge); r->cedges = r->cedges > 0 ? r->cedges * 2 : 64; if (OldSize == 0) { r->edges = (NSVGedge*)AllocatePool(64 * sizeof(NSVGedge)); } else r->edges = (NSVGedge*)ReallocatePool(OldSize, sizeof(NSVGedge) * r->cedges, r->edges); if (r->edges == NULL) return; } e = &r->edges[r->nedges]; r->nedges++; if (y0 < y1) { e->x0 = x0; e->y0 = y0; e->x1 = x1; e->y1 = y1; e->dir = 1; } else { e->x0 = x1; e->y0 = y1; e->x1 = x0; e->y1 = y0; e->dir = -1; } } static float nsvg__normalize(float *x, float* y) { // float d = sqrtf((*x)*(*x) + (*y)*(*y)); float d = SqrtF(SqrF(*x) + SqrF(*y)); if (d > 1e-6f) { float id = 1.0f / d; *x *= id; *y *= id; } return d; } //static float nsvg__absf(float x) { return x < 0 ? -x : x; } #define nsvg__absf(x) FabsF(x) //static float nsvg__sqr(float x) { return x*x; } #define nsvg__sqr(x) SqrF(x) // 0 1 2 3 4 5 6 7 static float nsvg__controlPathLength(float x1, float y1, float x2, float y2, float x3, float y3, float x4, float y4) { float l1, l2, l3; l1 = (float) sqrtf(nsvg__sqr(x2 - x1) + nsvg__sqr(y2 - y1)); l2 = (float) sqrtf(nsvg__sqr(x3 - x2) + nsvg__sqr(y3 - y2)); l3 = (float) sqrtf(nsvg__sqr(x4 - x3) + nsvg__sqr(y4 - y3)); return l1 + l2 + l3; } static void nsvg__flattenCubicBez2(NSVGrasterizer* r, float* x, float* t, int type) { #ifdef DEBUG_TRACE DBG("nsvg__flattenCubicBez2\n"); #endif float ax, ay, bx, by, cx, cy, dx, dy; float x1, y1, x2, y2, x3, y3, x4, y4; // float pointX, pointY; NSVGpoint p; float firstFDX, firstFDY, secondFDX, secondFDY, thirdFDX, thirdFDY; float h, h2, h3; float control_path_len; int N; x1 = x[0]*t[0] + x[1]*t[2] + t[4]; y1 = x[0]*t[1] + x[1]*t[3] + t[5]; x2 = x[2]*t[0] + x[3]*t[2] + t[4]; y2 = x[2]*t[1] + x[3]*t[3] + t[5]; x3 = x[4]*t[0] + x[5]*t[2] + t[4]; y3 = x[4]*t[1] + x[5]*t[3] + t[5]; x4 = x[6]*t[0] + x[7]*t[2] + t[4]; y4 = x[6]*t[1] + x[7]*t[3] + t[5]; control_path_len = nsvg__controlPathLength(x1, y1, x2, y2, x3, y3, x4, y4); /* This is going to need tweaking, gives approximate same number of divisons as old code on the test image */ N = (int)(control_path_len / ( 32 * r->tessTol)) + 2; if (N > 1024) N = 1024; /* Compute polynomial coefficients from Bezier points */ ax = -x1 + 3.f * x2 + -3.f * x3 + x4; ay = -y1 + 3.f * y2 + -3.f * y3 + y4; bx = 3.f * x1 - 6.f * x2 + 3.f * x3; by = 3.f * y1 - 6.f * y2 + 3.f * y3; cx = 3.0f * (x2 - x1); //-3 * x1 + 3 * x2; cy = 3.0f * (y2 - y1); //-3 * y1 + 3 * y2; dx = x1; dy = y1; /* Set up step size */ h = 1.0f / (N-1); h2 = h * h; h3 = h2 * h; /* Compute forward differences from Bezier points and "h" */ p.x = dx; p.y = dy; firstFDX = ((ax * h + bx) * h + cx) * h; firstFDY = ((ay * h + by) * h + cy) * h; secondFDX = (6.0f * ax * h + 2.0f * bx) * h2; secondFDY = (6.0f * ay * h + 2.0f * by) * h2; thirdFDX = 6.0f * ax * h3; thirdFDY = 6.0f * ay * h3; /* Compute points at each step */ for (int i = 0; i < N-1; i++) { nsvg__addPathPoint(r, &p, NULL, 0); p.x += firstFDX; p.y += firstFDY; firstFDX += secondFDX; firstFDY += secondFDY; secondFDX += thirdFDX; secondFDY += thirdFDY; } nsvg__addPathPoint(r, &p, NULL, type); return; } static void nsvg__flattenShape(NSVGrasterizer* r, NSVGshape* shape, float* xform) { #ifdef DEBUG_TRACE DBG("nsvg__flattenShape\n"); #endif // int j; NSVGpath* path; NSVGpoint pt; // nsvg__dumpFloat("flattenShape with", xform, 6); for (path = shape->paths; path != NULL; path = path->next) { r->npoints = 0; // Flatten path pt.x = path->pts[0]; pt.y = path->pts[1]; nsvg__addPathPoint(r, &pt, xform, 0); for (int i = 0; i < path->npts-1; i += 3) { float* p = &path->pts[i*2]; nsvg__flattenCubicBez2(r, p, xform, 0); } // Close path nsvg__addPathPoint(r, &pt, xform, 0); // Build edges for (int i = 0, j = r->npoints-1; i < r->npoints; j = i++) nsvg__addEdge(r, r->points[j].x, r->points[j].y, r->points[i].x, r->points[i].y); } } enum NSVGpointFlags { NSVG_PT_CORNER = 0x01, NSVG_PT_BEVEL = 0x02, NSVG_PT_LEFT = 0x04 }; static void nsvg__initClosed(NSVGpoint* left, NSVGpoint* right, NSVGpoint* p0, NSVGpoint* p1, float lineWidth) { float w = lineWidth * 0.5f; float dx = p1->x - p0->x; float dy = p1->y - p0->y; float len = nsvg__normalize(&dx, &dy); float px = p0->x + dx*len*0.5f, py = p0->y + dy*len*0.5f; float dlx = dy, dly = -dx; float lx = px - dlx*w, ly = py - dly*w; float rx = px + dlx*w, ry = py + dly*w; left->x = lx; left->y = ly; right->x = rx; right->y = ry; } static void nsvg__buttCap(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p, float dx, float dy, float lineWidth, int connect) { float w = lineWidth * 0.5f; float px = p->x, py = p->y; float dlx = dy, dly = -dx; float lx = px - dlx*w, ly = py - dly*w; float rx = px + dlx*w, ry = py + dly*w; nsvg__addEdge(r, lx, ly, rx, ry); if (connect) { nsvg__addEdge(r, left->x, left->y, lx, ly); nsvg__addEdge(r, rx, ry, right->x, right->y); } left->x = lx; left->y = ly; right->x = rx; right->y = ry; } static void nsvg__squareCap(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p, float dx, float dy, float lineWidth, int connect) { #ifdef DEBUG_TRACE DBG("nsvg__squareCap\n"); #endif float w = lineWidth * 0.5f; float px = p->x - dx*w, py = p->y - dy*w; float dlx = dy, dly = -dx; float lx = px - dlx*w, ly = py - dly*w; float rx = px + dlx*w, ry = py + dly*w; nsvg__addEdge(r, lx, ly, rx, ry); if (connect) { nsvg__addEdge(r, left->x, left->y, lx, ly); nsvg__addEdge(r, rx, ry, right->x, right->y); } left->x = lx; left->y = ly; right->x = rx; right->y = ry; } #ifndef NSVG_PI #define NSVG_PI (3.14159265358979323846264338327f) #endif static void nsvg__roundCap(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p, float dx, float dy, float lineWidth, int ncap, int connect) { #ifdef DEBUG_TRACE DBG("nsvg__roundCap\n"); #endif float w = lineWidth * 0.5f; float px = p->x, py = p->y; float dlx = dy, dly = -dx; float lx = 0, ly = 0, rx = 0, ry = 0, prevx = 0, prevy = 0; for (int i = 0; i < ncap; i++) { float a = (float)i/(float)(ncap-1)*NSVG_PI; float ax = cosf(a) * w, ay = sinf(a) * w; float x = px - dlx*ax - dx*ay; float y = py - dly*ax - dy*ay; if (i > 0) nsvg__addEdge(r, prevx, prevy, x, y); prevx = x; prevy = y; if (i == 0) { lx = x; ly = y; } else if (i == ncap-1) { rx = x; ry = y; } } if (connect) { nsvg__addEdge(r, left->x, left->y, lx, ly); nsvg__addEdge(r, rx, ry, right->x, right->y); } left->x = lx; left->y = ly; right->x = rx; right->y = ry; } static void nsvg__bevelJoin(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p0, NSVGpoint* p1, float lineWidth) { #ifdef DEBUG_TRACE DBG("nsvg__bevelJoin\n"); #endif float w = lineWidth * 0.5f; float dlx0 = p0->dy, dly0 = -p0->dx; float dlx1 = p1->dy, dly1 = -p1->dx; float lx0 = p1->x - (dlx0 * w), ly0 = p1->y - (dly0 * w); float rx0 = p1->x + (dlx0 * w), ry0 = p1->y + (dly0 * w); float lx1 = p1->x - (dlx1 * w), ly1 = p1->y - (dly1 * w); float rx1 = p1->x + (dlx1 * w), ry1 = p1->y + (dly1 * w); nsvg__addEdge(r, lx0, ly0, left->x, left->y); nsvg__addEdge(r, lx1, ly1, lx0, ly0); nsvg__addEdge(r, right->x, right->y, rx0, ry0); nsvg__addEdge(r, rx0, ry0, rx1, ry1); left->x = lx1; left->y = ly1; right->x = rx1; right->y = ry1; } static void nsvg__miterJoin(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p0, NSVGpoint* p1, float lineWidth) { #ifdef DEBUG_TRACE DBG("nsvg__miterJoin\n"); #endif float w = lineWidth * 0.5f; float dlx0 = p0->dy, dly0 = -p0->dx; float dlx1 = p1->dy, dly1 = -p1->dx; float lx0, rx0, lx1, rx1; float ly0, ry0, ly1, ry1; if (p1->flags & NSVG_PT_LEFT) { lx0 = lx1 = p1->x - p1->dmx * w; ly0 = ly1 = p1->y - p1->dmy * w; nsvg__addEdge(r, lx1, ly1, left->x, left->y); rx0 = p1->x + (dlx0 * w); ry0 = p1->y + (dly0 * w); rx1 = p1->x + (dlx1 * w); ry1 = p1->y + (dly1 * w); nsvg__addEdge(r, right->x, right->y, rx0, ry0); nsvg__addEdge(r, rx0, ry0, rx1, ry1); } else { lx0 = p1->x - (dlx0 * w); ly0 = p1->y - (dly0 * w); lx1 = p1->x - (dlx1 * w); ly1 = p1->y - (dly1 * w); nsvg__addEdge(r, lx0, ly0, left->x, left->y); nsvg__addEdge(r, lx1, ly1, lx0, ly0); rx0 = rx1 = p1->x + p1->dmx * w; ry0 = ry1 = p1->y + p1->dmy * w; nsvg__addEdge(r, right->x, right->y, rx1, ry1); } left->x = lx1; left->y = ly1; right->x = rx1; right->y = ry1; } static void nsvg__roundJoin(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p0, NSVGpoint* p1, float lineWidth, int ncap) { #ifdef DEBUG_TRACE DBG("nsvg__roundJoin\n"); #endif int n; float w = lineWidth * 0.5f; float dlx0 = p0->dy, dly0 = -p0->dx; float dlx1 = p1->dy, dly1 = -p1->dx; float a0 = atan2f(dly0, dlx0); float a1 = atan2f(dly1, dlx1); float da = a1 - a0; float lx, ly, rx, ry; if (da < -NSVG_PI) da += PI2; //NSVG_PI*2; if (da > NSVG_PI) da -= PI2; //NSVG_PI*2; n = (int)ceilf((nsvg__absf(da) / NSVG_PI) * (float)ncap); if (n < 2) n = 2; if (n > ncap) n = ncap; lx = left->x; ly = left->y; rx = right->x; ry = right->y; for (int i = 0; i < n; i++) { float u = (float)i/(float)(n-1); float a = a0 + u*da; float ax = cosf(a) * w, ay = sinf(a) * w; float lx1 = p1->x - ax, ly1 = p1->y - ay; float rx1 = p1->x + ax, ry1 = p1->y + ay; nsvg__addEdge(r, lx1, ly1, lx, ly); nsvg__addEdge(r, rx, ry, rx1, ry1); lx = lx1; ly = ly1; rx = rx1; ry = ry1; } left->x = lx; left->y = ly; right->x = rx; right->y = ry; } static void nsvg__straightJoin(NSVGrasterizer* r, NSVGpoint* left, NSVGpoint* right, NSVGpoint* p1, float lineWidth) { float w = lineWidth * 0.5f; float lx = p1->x - (p1->dmx * w), ly = p1->y - (p1->dmy * w); float rx = p1->x + (p1->dmx * w), ry = p1->y + (p1->dmy * w); nsvg__addEdge(r, lx, ly, left->x, left->y); nsvg__addEdge(r, right->x, right->y, rx, ry); left->x = lx; left->y = ly; right->x = rx; right->y = ry; } static int nsvg__curveDivs(float r, float arc, float tol) { float da = acosf(r / (r + tol)) * 2.0f; int divs = (int)ceilf(arc / da); if (divs < 2) divs = 2; return divs; } static void nsvg__expandStroke(NSVGrasterizer* r, NSVGpoint* points, int npoints, int closed, int lineJoin, int lineCap, float lineWidth) { #ifdef DEBUG_TRACE DBG("nsvg__expandStroke\n"); #endif int ncap = nsvg__curveDivs(lineWidth*0.5f, NSVG_PI, r->tessTol); // Calculate divisions per half circle. NSVGpoint left = {0,0,0,0,0,0,0,0,{0,0,0}}, right = {0,0,0,0,0,0,0,0,{0,0,0}}, firstLeft = {0,0,0,0,0,0,0,0,{0,0,0}}, firstRight = {0,0,0,0,0,0,0,0,{0,0,0}}; NSVGpoint* p0, *p1; int s, e; // Build stroke edges if (closed) { // Looping p0 = &points[npoints-1]; p1 = &points[0]; s = 0; e = npoints; } else { // Add cap p0 = &points[0]; p1 = &points[1]; s = 1; e = npoints-1; } if (closed) { nsvg__initClosed(&left, &right, p0, p1, lineWidth); firstLeft = left; firstRight = right; } else { // Add cap float dx = p1->x - p0->x; float dy = p1->y - p0->y; nsvg__normalize(&dx, &dy); if (lineCap == NSVG_CAP_BUTT) nsvg__buttCap(r, &left, &right, p0, dx, dy, lineWidth, 0); else if (lineCap == NSVG_CAP_SQUARE) nsvg__squareCap(r, &left, &right, p0, dx, dy, lineWidth, 0); else if (lineCap == NSVG_CAP_ROUND) nsvg__roundCap(r, &left, &right, p0, dx, dy, lineWidth, ncap, 0); } for (int j = s; j < e; ++j) { if (p1->flags & NSVG_PT_CORNER) { if (lineJoin == NSVG_JOIN_ROUND) nsvg__roundJoin(r, &left, &right, p0, p1, lineWidth, ncap); else if (lineJoin == NSVG_JOIN_BEVEL || (p1->flags & NSVG_PT_BEVEL)) nsvg__bevelJoin(r, &left, &right, p0, p1, lineWidth); else nsvg__miterJoin(r, &left, &right, p0, p1, lineWidth); } else { nsvg__straightJoin(r, &left, &right, p1, lineWidth); } p0 = p1++; } if (closed) { // Loop it nsvg__addEdge(r, firstLeft.x, firstLeft.y, left.x, left.y); nsvg__addEdge(r, right.x, right.y, firstRight.x, firstRight.y); } else { // Add cap float dx = p1->x - p0->x; float dy = p1->y - p0->y; nsvg__normalize(&dx, &dy); if (lineCap == NSVG_CAP_BUTT) nsvg__buttCap(r, &right, &left, p1, -dx, -dy, lineWidth, 1); else if (lineCap == NSVG_CAP_SQUARE) nsvg__squareCap(r, &right, &left, p1, -dx, -dy, lineWidth, 1); else if (lineCap == NSVG_CAP_ROUND) nsvg__roundCap(r, &right, &left, p1, -dx, -dy, lineWidth, ncap, 1); } } static void nsvg__prepareStroke(NSVGrasterizer* r, float miterLimit, int lineJoin) { #ifdef DEBUG_TRACE DBG("nsvg__prepareStroke\n"); #endif NSVGpoint *p0, *p1; p0 = &r->points[r->npoints-1]; p1 = &r->points[0]; for (int i = 0; i < r->npoints; i++) { // Calculate segment direction and length p0->dx = p1->x - p0->x; p0->dy = p1->y - p0->y; p0->len = nsvg__normalize(&p0->dx, &p0->dy); // Advance p0 = p1++; } // calculate joins p0 = &r->points[r->npoints-1]; p1 = &r->points[0]; for (int j = 0; j < r->npoints; j++) { float dlx0, dly0, dlx1, dly1, dmr2, cross; dlx0 = p0->dy; dly0 = -p0->dx; dlx1 = p1->dy; dly1 = -p1->dx; // Calculate extrusions p1->dmx = (dlx0 + dlx1) * 0.5f; p1->dmy = (dly0 + dly1) * 0.5f; dmr2 = p1->dmx*p1->dmx + p1->dmy*p1->dmy; if (dmr2 > 0.000001f) { float s2 = 1.0f / dmr2; if (s2 > 600.0f) { s2 = 600.0f; } p1->dmx *= s2; p1->dmy *= s2; } // Clear flags, but keep the corner. p1->flags = (p1->flags & NSVG_PT_CORNER) ? NSVG_PT_CORNER : 0; // Keep track of left turns. cross = p1->dx * p0->dy - p0->dx * p1->dy; if (cross > 0.0f) p1->flags |= NSVG_PT_LEFT; // Check to see if the corner needs to be beveled. if (p1->flags & NSVG_PT_CORNER) { if ((dmr2 * miterLimit*miterLimit) < 1.0f || lineJoin == NSVG_JOIN_BEVEL || lineJoin == NSVG_JOIN_ROUND) { p1->flags |= NSVG_PT_BEVEL; } } p0 = p1++; } } static void nsvg__flattenShapeStroke(NSVGrasterizer* r, NSVGshape* shape, float* xform) { #ifdef DEBUG_TRACE DBG("nsvg__flattenShapeStroke\n"); #endif int closed; NSVGpath* path; NSVGpoint* p0, *p1; NSVGpoint p; float lineWidth = 0.5; float scalex1 = fabsf(xform[0]); float scalex2 = fabsf(xform[2]); float scaley1 = fabsf(xform[1]); float scaley2 = fabsf(xform[3]); // float scale = (scalex > scaley)?scalex:scaley; //(scalex + scaley) * 0.5f float scale = (sqrtf(scalex1*scalex1 + scalex2*scalex2) + sqrtf(scaley1*scaley1 + scaley2*scaley2)) * 0.5f; float miterLimit = shape->miterLimit; int lineJoin = shape->strokeLineJoin; int lineCap = shape->strokeLineCap; /* if (shape->isText) { lineWidth = shape->strokeWidth; } else { */ lineWidth = shape->strokeWidth * scale; // } //nsvg__dumpFloat("shapeStroke", xform, 6); for (path = shape->paths; path != NULL; path = path->next) { // Flatten path r->npoints = 0; p.x = path->pts[0]; p.y = path->pts[1]; nsvg__addPathPoint(r, &p, xform, NSVG_PT_CORNER); for (int i = 0; i < path->npts-1; i += 3) { float* pt = &path->pts[i*2]; nsvg__flattenCubicBez2(r, pt, xform, NSVG_PT_CORNER); } if (r->npoints < 2) continue; closed = path->closed; // If the first and last points are the same, remove the last, mark as closed path. p0 = &r->points[r->npoints-1]; p1 = &r->points[0]; if (nsvg__ptEquals(p0, p1, r->distTol)) { r->npoints--; p0 = &r->points[r->npoints-1]; closed = 1; } if (shape->strokeDashCount > 0) { int idash = 0, dashState = 1; float totalDist = 0, dashLen, allDashLen, dashOffset; NSVGpoint* cur; if (closed) nsvg__appendPathPoint(r, p1); // Duplicate points -> points2. nsvg__duplicatePoints(r); r->npoints = 0; cur = &r->points2[0]; nsvg__appendPathPoint(r, cur); // Figure out dash offset. allDashLen = 0; for (int j = 0; j < shape->strokeDashCount; j++) allDashLen += shape->strokeDashArray[j]; if (shape->strokeDashCount & 1) allDashLen *= 2.0f; // Find location inside pattern dashOffset = fmodf(shape->strokeDashOffset, allDashLen); if (dashOffset < 0.0f) dashOffset += allDashLen; while (dashOffset > shape->strokeDashArray[idash]) { dashOffset -= shape->strokeDashArray[idash]; idash = (idash + 1) % shape->strokeDashCount; } dashLen = (shape->strokeDashArray[idash] - dashOffset) * scale; for (int j = 1; j < r->npoints2; ) { float dx = r->points2[j].x - cur->x; float dy = r->points2[j].y - cur->y; float dist = sqrtf(dx*dx + dy*dy); if ((totalDist + dist) > dashLen) { // Calculate intermediate point float d = (dashLen - totalDist) / dist; NSVGpoint pc; pc.x = cur->x + dx * d; pc.y = cur->y + dy * d; nsvg__addPathPoint(r, &pc, NULL, NSVG_PT_CORNER); // Stroke if (r->npoints > 1 && dashState) { nsvg__prepareStroke(r, miterLimit, lineJoin); nsvg__expandStroke(r, r->points, r->npoints, 0, lineJoin, lineCap, lineWidth); } // Advance dash pattern dashState = !dashState; idash = (idash+1) % shape->strokeDashCount; dashLen = shape->strokeDashArray[idash] * scale; // Restart cur->x = pc.x; cur->y = pc.y; cur->flags = NSVG_PT_CORNER; totalDist = 0.0f; r->npoints = 0; nsvg__appendPathPoint(r, cur); } else { totalDist += dist; cur = &r->points2[j]; nsvg__appendPathPoint(r, cur); j++; } } // Stroke any leftover path if (r->npoints > 1 && dashState) nsvg__expandStroke(r, r->points, r->npoints, 0, lineJoin, lineCap, lineWidth); } else { nsvg__prepareStroke(r, miterLimit, lineJoin); nsvg__expandStroke(r, r->points, r->npoints, closed, lineJoin, lineCap, lineWidth); } } } /* static int nsvg__cmpEdge(const void *p, const void *q) { const NSVGedge* a = (const NSVGedge*)p; const NSVGedge* b = (const NSVGedge*)q; if (a->y0 < b->y0) return -1; if (a->y0 > b->y0) return 1; return 0; } */ static NSVGactiveEdge* nsvg__addActive(NSVGrasterizer* r, NSVGedge* e, float startPoint) { NSVGactiveEdge* z; if (r->freelist != NULL) { // Restore from freelist. z = r->freelist; r->freelist = z->next; } else { // Alloc new edge. z = (NSVGactiveEdge*)nsvgrast__alloc(r, sizeof(NSVGactiveEdge)); if (z == NULL) return NULL; } float dxdy = (e->x1 - e->x0) / (e->y1 - e->y0); // STBTT_assert(e->y0 <= start_point); // round dx down to avoid going too far if (dxdy < 0) z->dx = (int)(-floorf(NSVG__FIX * -dxdy)); else z->dx = (int)floorf(NSVG__FIX * dxdy); z->x = (int)floorf(NSVG__FIX * (e->x0 + dxdy * (startPoint - e->y0))); // z->x -= off_x * FIX; z->ey = e->y1; z->next = 0; z->dir = e->dir; return z; } static void nsvg__freeActive(NSVGrasterizer* r, NSVGactiveEdge* z) { z->next = r->freelist; r->freelist = z; } static void nsvg__fillScanline(UINT8* scanline, int len, int x0, int x1, int maxWeight, int* xmin, int* xmax) { int i = x0 >> NSVG__FIXSHIFT; int j = x1 >> NSVG__FIXSHIFT; if (i < *xmin) *xmin = i; if (j > *xmax) *xmax = j; if (i < len && j >= 0) { if (i == j) { // x0,x1 are the same pixel, so compute combined coverage scanline[i] = (UINT8)(scanline[i] + ((x1 - x0) * maxWeight >> NSVG__FIXSHIFT)); } else { if (i >= 0) // add antialiasing for x0 scanline[i] = (UINT8)(scanline[i] + (((NSVG__FIX - (x0 & NSVG__FIXMASK)) * maxWeight) >> NSVG__FIXSHIFT)); else i = -1; // clip if (j < len) // add antialiasing for x1 scanline[j] = (UINT8)(scanline[j] + (((x1 & NSVG__FIXMASK) * maxWeight) >> NSVG__FIXSHIFT)); else j = len; // clip for (++i; i < j; ++i) // fill pixels between x0 and x1 scanline[i] = (UINT8)(scanline[i] + maxWeight); } } } // note: this routine clips fills that extend off the edges... ideally this // wouldn't happen, but it could happen if the truetype glyph bounding boxes // are wrong, or if the user supplies a too-small bitmap static void nsvg__fillActiveEdges(UINT8* scanline, int len, NSVGactiveEdge* e, int maxWeight, int* xmin, int* xmax, char fillRule) { #ifdef DEBUG_TRACE DBG("nsvg__fillActiveEdges\n"); #endif // non-zero winding fill int x0 = 0, w = 0; if (fillRule == NSVG_FILLRULE_NONZERO) { // Non-zero while (e != NULL) { if (w == 0) { // if we're currently at zero, we need to record the edge start point x0 = e->x; w += e->dir; } else { int x1 = e->x; w += e->dir; // if we went to zero, we need to draw if (w == 0) nsvg__fillScanline(scanline, len, x0, x1, maxWeight, xmin, xmax); } e = e->next; } } else if (fillRule == NSVG_FILLRULE_EVENODD) { // Even-odd while (e != NULL) { if (w == 0) { // if we're currently at zero, we need to record the edge start point x0 = e->x; w = 1; } else { int x1 = e->x; w = 0; nsvg__fillScanline(scanline, len, x0, x1, maxWeight, xmin, xmax); } e = e->next; } } } static float nsvg__clampf(float a, float mn, float mx) { return a < mn ? mn : (a > mx ? mx : a); } static UINT32 nsvg__RGBA(UINT8 r, UINT8 g, UINT8 b, UINT8 a) { return (b) | (g << 8) | (r << 16) | (a << 24); } static unsigned int nsvg__lerpRGBA(unsigned int c0, unsigned int c1, float u, float opacity) { float xu = nsvg__clampf(u, 0.0f, 1.0f) * 256.0f; int iu = (int)(xu); //0..256 int ia = (int)(nsvg__clampf(opacity, 0.0f, 1.0f) * 256.0f); int b = (((c0) & 0xff)*(256-iu) + (((c1) & 0xff)*iu)) >> 8; int g = (((c0>>8) & 0xff)*(256-iu) + (((c1>>8) & 0xff)*iu)) >> 8; int r = (((c0>>16) & 0xff)*(256-iu) + (((c1>>16) & 0xff)*iu)) >> 8; int a = ((((c0>>24) & 0xff)*(256-iu) + (((c1>>24) & 0xff)*iu)) * ia) >> 16; return nsvg__RGBA((UINT8)r, (UINT8)g, (UINT8)b, (UINT8)a); } static unsigned int nsvg__applyOpacity(unsigned int c, float u) { int iu = (int)(nsvg__clampf(u, 0.0f, 1.0f) * 256.0f); int b = (c) & 0xff; int g = (c>>8) & 0xff; int r = (c>>16) & 0xff; int a = (((c>>24) & 0xff)*iu) >> 8; return nsvg__RGBA((UINT8)r, (UINT8)g, (UINT8)b, (UINT8)a); } static inline int nsvg__div255(int x) { return ((x+1) * 257) >> 16; } static void nsvg__scanlineBit( UINT8* row, int count, UINT8* cover, int x, int y, /* float tx, float ty, float scalex, float scaley, */ NSVGcachedPaint* cache) { #ifdef DEBUG_TRACE DBG("nsvg__scanlineBit\n"); #endif //xxx where is security check that x/8 and (x+count)/8 is inside row[] index? // called by r->fscanline(&r->bitmap[y * r->stride], xmax-xmin+1, &r->scanline[xmin], xmin, y,/* tx,ty, scalex, scaley, */ cache); int x1 = x + count; for (; x < x1; x++) { row[x / 8] |= 1 << (x % 8); } } static void nsvg__scanlineSolid(UINT8* row, int count, UINT8* cover, int x, int y, /* float tx, float ty, float scalex, float scaley, */ NSVGcachedPaint* cache) { #ifdef DEBUG_TRACE DBG("nsvg__scanlineSolid\n"); #endif // static int once = 0; UINT8* dst = row + x*4; if (cache->type == NSVG_PAINT_COLOR) { int cr, cg, cb, ca; cr = cache->colors[0] & 0xff; cg = (cache->colors[0] >> 8) & 0xff; cb = (cache->colors[0] >> 16) & 0xff; ca = (cache->colors[0] >> 24) & 0xff; for (int i = 0; i < count; i++) { int r,g,b; int a = nsvg__div255((int)cover[0] * ca); int ia = 255 - a; // Premultiply r = nsvg__div255(cr * a); g = nsvg__div255(cg * a); b = nsvg__div255(cb * a); // Blend over r += nsvg__div255(ia * (int)dst[0]); g += nsvg__div255(ia * (int)dst[1]); b += nsvg__div255(ia * (int)dst[2]); a += nsvg__div255(ia * (int)dst[3]); dst[0] = (UINT8)r; dst[1] = (UINT8)g; dst[2] = (UINT8)b; dst[3] = (UINT8)a; cover++; dst += 4; } } else if (cache->type == NSVG_PAINT_LINEAR_GRADIENT) { // TODO: spread modes. // TODO: plenty of opportunities to optimize. float fx, fy, gy; float* t = cache->xform; // nsvg__dumpFloat("cache grad xform", t, 6); int cr, cg, cb, ca; unsigned int c; //x,y - pixels fx = (float)x; fy = (float)y; // dx = 1.0f; gy = fx*t[1] + fy*t[3] + t[5]; //gradient direction. Point at cut for (int i = 0; i < count; i++) { int r,g,b,a,ia; int level = cache->coarse; c = cache->colors[dither(nsvg__clampf(gy*(255.0f-level), 0, (float)(255-level)), level)]; //assumed gy = 0.0 ... 1.0f cr = (c) & 0xff; cg = (c >> 8) & 0xff; cb = (c >> 16) & 0xff; ca = (c >> 24) & 0xff; a = nsvg__div255((int)cover[0] * ca); ia = 255 - a; // Premultiply r = nsvg__div255(cr * a); g = nsvg__div255(cg * a); b = nsvg__div255(cb * a); // Blend over r += nsvg__div255(ia * (int)dst[0]); g += nsvg__div255(ia * (int)dst[1]); b += nsvg__div255(ia * (int)dst[2]); a += nsvg__div255(ia * (int)dst[3]); dst[0] = (UINT8)r; dst[1] = (UINT8)g; dst[2] = (UINT8)b; dst[3] = (UINT8)a; cover++; dst += 4; // fx += dx; gy += t[1]; } } else if (cache->type == NSVG_PAINT_RADIAL_GRADIENT) { // TODO: spread modes. // TODO: plenty of opportunities to optimize. // TODO: focus (fx,fy) float fx, fy, gx, gy, gd; float* t = cache->xform; // nsvg__dumpFloat("cache grad xform", t, 6); int cr, cg, cb, ca; unsigned int c; fx = (float)x; fy = (float)y; // dx = 1.0f; gx = fx*t[0] + fy*t[2] + t[4]; gy = fx*t[1] + fy*t[3] + t[5]; for (int i = 0; i < count; i++) { int r,g,b,a,ia; gd = sqrtf(gx*gx + gy*gy); // DBG("gx=%f gy=%f\n", gx, gy); int level = cache->coarse; c = cache->colors[dither(nsvg__clampf(gd*(255.0f-level*2), 0, (254.99f-level*2)), level)]; cr = (c) & 0xff; cg = (c >> 8) & 0xff; cb = (c >> 16) & 0xff; ca = (c >> 24) & 0xff; a = nsvg__div255((int)cover[0] * ca); ia = 255 - a; // Premultiply r = nsvg__div255(cr * a); g = nsvg__div255(cg * a); b = nsvg__div255(cb * a); // Blend over r += nsvg__div255(ia * (int)dst[0]); g += nsvg__div255(ia * (int)dst[1]); b += nsvg__div255(ia * (int)dst[2]); a += nsvg__div255(ia * (int)dst[3]); dst[0] = (UINT8)r; dst[1] = (UINT8)g; dst[2] = (UINT8)b; dst[3] = (UINT8)a; cover++; dst += 4; // fx += dx; gx += t[0]; gy += t[1]; } } else if (cache->type == NSVG_PAINT_PATTERN) { // TODO float fx, fy, dx, gx, gy; float* t = cache->xform; // EG_IMAGE *Pattern = (EG_IMAGE *)cache->image; XImage *Pattern = (XImage*)cache->image; if (!Pattern) { DBG("no pattern to fill\n"); return; } INTN Width = Pattern->GetWidth(); INTN Height = Pattern->GetHeight(); int ix, iy; // INTN j; fx = (float)x; fy = (float)y; dx = 1.0f; // unsigned int c; for (int i = 0; i < count; i++) { int r,g,b,a,ia; gx = fx*t[0] + fy*t[2] + t[4]; gy = fx*t[1] + fy*t[3] + t[5]; ix = dither(gx * Width, 2) % Width; iy = dither(gy * Height, 2) % Height; // j = iy * Width + ix; EFI_GRAPHICS_OUTPUT_BLT_PIXEL cp = Pattern->GetPixel(ix, iy); // cr = Pattern->PixelData[j].r; // cb = Pattern->PixelData[j].b; // cg = Pattern->PixelData[j].g; // ca = Pattern->PixelData[j].a; // cr = cp.Red; a = nsvg__div255((int)cover[0] * cp.Reserved); ia = 255 - a; // Premultiply r = nsvg__div255(cp.Red * a); g = nsvg__div255(cp.Green * a); b = nsvg__div255(cp.Blue * a); // Blend over r += nsvg__div255(ia * (int)dst[0]); g += nsvg__div255(ia * (int)dst[1]); b += nsvg__div255(ia * (int)dst[2]); a += nsvg__div255(ia * (int)dst[3]); dst[0] = (UINT8)r; dst[1] = (UINT8)g; dst[2] = (UINT8)b; dst[3] = (UINT8)a; cover++; dst += 4; fx += dx; } } else if (cache->type == NSVG_PAINT_CONIC_GRADIENT) { // TODO: spread modes. // TODO: plenty of opportunities to optimize. // TODO: focus (fx,fy) float fx, fy, gx, gy, gd; float* t = cache->xform; // nsvg__dumpFloat("cache grad xform", t, 6); int cr, cg, cb, ca; unsigned int c; fx = (float)x; fy = (float)y; // dx = 1.0f; gx = fx*t[0] + fy*t[2] + t[4]; gy = fx*t[1] + fy*t[3] + t[5]; for (int i = 0; i < count; i++) { int r,g,b,a,ia; if ((gx == 0.f) && (gy == 0.f)) { c = 0; } else { gd = (Atan2F(gy, gx) + PI) / PI2; c = cache->colors[dither(nsvg__clampf(gd*254.0f, 0, 253.99f), 1)]; } cr = (c) & 0xff; cg = (c >> 8) & 0xff; cb = (c >> 16) & 0xff; ca = (c >> 24) & 0xff; a = nsvg__div255((int)cover[0] * ca); ia = 255 - a; // Premultiply r = nsvg__div255(cr * a); g = nsvg__div255(cg * a); b = nsvg__div255(cb * a); // Blend over r += nsvg__div255(ia * (int)dst[0]); g += nsvg__div255(ia * (int)dst[1]); b += nsvg__div255(ia * (int)dst[2]); a += nsvg__div255(ia * (int)dst[3]); dst[0] = (UINT8)r; dst[1] = (UINT8)g; dst[2] = (UINT8)b; dst[3] = (UINT8)a; cover++; dst += 4; // fx += dx; gx += t[0]; gy += t[1]; } } } UINT8* nsvg__findStencil(NSVGrasterizer *r, int index) { NSVGstencil* sl = r->stencilList; while (sl != NULL) { if (sl->index == index) return sl->square; sl = sl->next; } return NULL; } static void nsvg__rasterizeSortedEdges(NSVGrasterizer *r, /* float tx, float ty, float scalex, float scaley, */ NSVGcachedPaint* cache, char fillRule, NSVGclip* clip) { #ifdef DEBUG_TRACE DBG("nsvg__rasterizeSortedEdges\n"); #endif NSVGactiveEdge *active = NULL; int e = 0; int maxWeight = (255 / NSVG__SUBSAMPLES); // weight per vertical scanline int xmin, xmax; for (int y = 0; y < r->height; y++) { SetMem(r->scanline, r->width, 0); xmin = r->width; xmax = 0; for (int s = 0; s < NSVG__SUBSAMPLES; ++s) { // find center of pixel for this scanline float scany = (float)(y*NSVG__SUBSAMPLES + s) + 0.5f; NSVGactiveEdge **step = &active; // update all active edges; // remove all active edges that terminate before the center of this scanline while (*step) { NSVGactiveEdge *z = *step; if (z->ey <= scany) { *step = z->next; // delete from list nsvg__freeActive(r, z); } else { z->x += z->dx; // advance to position for current scanline step = &((*step)->next); // advance through list } } // resort the list if needed for (;;) { int changed = 0; step = &active; while (*step && (*step)->next) { if ((*step)->x > (*step)->next->x) { NSVGactiveEdge* t = *step; NSVGactiveEdge* q = t->next; t->next = q->next; q->next = t; *step = q; changed = 1; } step = &(*step)->next; } if (!changed) break; } // insert all edges that start before the center of this scanline -- omit ones that also end on this scanline while (e < r->nedges && r->edges[e].y0 <= scany) { if (r->edges[e].y1 > scany) { NSVGactiveEdge* z = nsvg__addActive(r, &r->edges[e], scany); if (z == NULL) break; // find insertion point if (active == NULL) { active = z; } else if (z->x < active->x) { // insert at front z->next = active; active = z; } else { // find thing to insert AFTER NSVGactiveEdge* p = active; while (p->next && p->next->x < z->x) p = p->next; // at this point, p->next->x is NOT < z->x z->next = p->next; p->next = z; } } e++; } // now process all active edges in non-zero fashion if (active != NULL) nsvg__fillActiveEdges(r->scanline, r->width, active, maxWeight, &xmin, &xmax, fillRule); } // Blit if (xmin < 0) xmin = 0; if (xmax > r->width-1) xmax = r->width-1; if (xmin <= xmax) { for (int i = 0; i < clip->count; i++) { UINT8* stencil = &r->stencil[r->stencilSize * clip->index[i] + y * r->stencilStride]; // UINT8* stencil = FindStencil(r, clip->index[i]); if (stencil) { for (int j = xmin; j <= xmax; j++) { if (((stencil[j / 8] >> (j % 8)) & 1) == 0) { r->scanline[j] = 0; } } } } r->fscanline(&r->bitmap[y * r->stride], xmax-xmin+1, &r->scanline[xmin], xmin, y,/* tx,ty, scalex, scaley, */ cache); } } } static void nsvg__unpremultiplyAlpha(UINT8* image, int w, int h, int stride) { #ifdef DEBUG_TRACE DBG("nsvg__unpremultiplyAlpha\n"); #endif // Unpremultiply for (int y = 0; y < h; y++) { UINT8 *row = &image[y*stride]; for (int x = 0; x < w; x++) { int r = row[0], g = row[1], b = row[2], a = row[3]; if (a != 0) { row[0] = (UINT8)(r*255/a); row[1] = (UINT8)(g*255/a); row[2] = (UINT8)(b*255/a); } row += 4; } } // Defringe for (int y = 0; y < h; y++) { UINT8 *row = &image[y*stride]; for (int x = 0; x < w; x++) { int r = 0, g = 0, b = 0, a = row[3], n = 0; if (a == 0) { if (x-1 > 0 && row[-1] != 0) { r += row[-4]; g += row[-3]; b += row[-2]; n++; } if (x+1 < w && row[7] != 0) { r += row[4]; g += row[5]; b += row[6]; n++; } if (y-1 > 0 && row[-stride+3] != 0) { r += row[-stride]; g += row[-stride+1]; b += row[-stride+2]; n++; } if (y+1 < h && row[stride+3] != 0) { r += row[stride]; g += row[stride+1]; b += row[stride+2]; n++; } if (n > 0) { row[0] = (UINT8)(r/n); row[1] = (UINT8)(g/n); row[2] = (UINT8)(b/n); } } row += 4; } } } static void nsvg__initPaint(NSVGcachedPaint* cache, NSVGpaint* paint, NSVGshape* shape, float *xformShape) { #ifdef DEBUG_TRACE DBG("nsvg__initPaint\n"); #endif NSVGgradient* grad = paint->paint.gradient; float opacity = shape->opacity; cache->type = paint->type; // DBG("shape=%s, paint-type=%d\n", shape->id, cache->type); if (cache->type == NSVG_PAINT_COLOR) { cache->colors[0] = nsvg__applyOpacity(paint->paint.color, opacity); return; } if (grad) { cache->coarse = grad->ditherCoarse; } if (cache->type == NSVG_PAINT_PATTERN) { cache->colors[0] = nsvg__applyOpacity(0, opacity); if (grad) { cache->image = ((NSVGpattern*)grad)->image; } float xform[6]; nsvg__xformIdentity(xform); xform[0] = shape->bounds[2] - shape->bounds[0]; xform[3] = shape->bounds[3] - shape->bounds[1]; xform[4] = shape->bounds[0]; xform[5] = shape->bounds[1]; nsvg__xformMultiply(xform, xformShape); nsvg__xformInverse(cache->xform, xform); return; } cache->spread = grad->spread; nsvg__xformInverse(cache->xform, xformShape); nsvg__xformMultiply(cache->xform, grad->xform); if (grad->nstops == 0) { SetMem(cache->colors, sizeof(cache->colors), 0); } else if (grad->nstops == 1) { for (int i = 0; i < 256; i++) { cache->colors[i] = nsvg__applyOpacity(grad->stops[i].color, opacity); } } else { //nstops=2 as usual gradient unsigned int ca, cb = 0; float ua, ub, du, u; int ia, ib, count; ca = nsvg__applyOpacity(grad->stops[0].color, opacity); ua = nsvg__clampf(grad->stops[0].offset, 0, 1); ub = nsvg__clampf(grad->stops[grad->nstops-1].offset, ua, 1); ia = (int)(ua * 255.0f); ib = (int)(ub * 255.0f); for (int i = 0; i < ia; i++) { cache->colors[i] = ca; //color from stop0 } for (int i = 0; i < grad->nstops-1; i++) { ca = grad->stops[i].color; cb = grad->stops[i+1].color; ua = nsvg__clampf(grad->stops[i].offset, 0, 1); //=0 ub = nsvg__clampf(grad->stops[i+1].offset, 0, 1); //=1 ia = (int)(ua * 255.0f); //=0 ib = (int)(ub * 255.0f); //=255 count = ib - ia; if (count <= 0) continue; u = 0; du = 1.0f / (float)count; for (int j = 0; j < count; j++) { cache->colors[ia+j] = nsvg__lerpRGBA(ca,cb,u, opacity); u += du; } } for (int i = ib; i < 256; i++) { //tail cache->colors[i] = cb; // cache->colors2[i] = cb; } } } static void nsvg__rasterizeShapes(NSVGrasterizer* r, NSVGshape* shapes, const char* groupName, float tx, float ty, float scalex, float scaley, UINT8* dst, int w, int h, int stride, NSVGscanlineFunction fscanline) { #ifdef DEBUG_TRACE DBG("nsvg__rasterizeShapes %s %f %f %f %f\n", groupName ? groupName : "", tx, ty, scalex, scaley); #endif NSVGshape *shape = NULL, *shapeLink = NULL; float xform[6], xform2[6]; float min_scale = fabsf(scalex) < fabsf(scaley) ? fabsf(scalex) : fabsf(scaley); r->bitmap = dst; r->width = w; r->height = h; r->stride = stride; r->fscanline = fscanline; if (w > r->cscanline) { int oldw = r->cscanline; r->cscanline = w; if (oldw == 0) { r->scanline = (UINT8*)AllocatePool(w); } else { r->scanline = (UINT8*)ReallocatePool(oldw, w, r->scanline); } if (r->scanline == NULL) return; } nsvg__xformSetScale(&xform2[0], scalex, scaley); xform2[4] = tx; xform2[5] = ty; for (shape = shapes; shape != NULL; shape = shape->next) { if (!(shape->flags & NSVG_VIS_VISIBLE)) continue; if ( groupName && !nsvg__isShapeInGroup(shape, groupName) ) { continue; } memcpy(&xform[0], shape->xform, sizeof(float)*6); xform[0] *= scalex; xform[1] *= scaley; xform[2] *= scalex; xform[3] *= scaley; xform[4] = xform[4] * scalex + tx; xform[5] = xform[5] * scaley + ty; if (!shape->link) { renderShape(r, shape, &xform[0], min_scale); } shapeLink = shape->link; //this is while (shapeLink) { memcpy(&xform2[0], &xform[0], sizeof(float)*6); nsvg__xformPremultiply(&xform2[0], shapeLink->xform); renderShape(r, shapeLink, &xform2[0], min_scale); if (!shape->isSymbol) { break; } shapeLink = shapeLink->next; } } r->bitmap = NULL; r->width = 0; r->height = 0; r->stride = 0; r->fscanline = NULL; } static void renderShape(NSVGrasterizer* r, NSVGshape* shape, float *xform, float min_scale) { #ifdef DEBUG_TRACE DBG("render shape %s %f %f %f %f %f %f\n", shape->id, xform[0], xform[1], xform[2], xform[3], xform[4], xform[5]); #endif NSVGedge *e = NULL; NSVGcachedPaint cache; SetMem(&cache, sizeof(NSVGcachedPaint), 0); // NSVGclip& clip = shape->clip; // DBG("renderShape %s with clips", shape->id); // for (int i=0; i < clip.count; i++) { // DBG(" %d", clip.index[i]); // } // DBG("\n"); if (shape->fill.type != NSVG_PAINT_NONE) { nsvg__resetPool(r); r->freelist = NULL; r->nedges = 0; nsvg__flattenShape(r, shape, xform); // Scale and translate edges for (int i = 0; i < r->nedges; i++) { e = &r->edges[i]; e->y0 *= NSVG__SUBSAMPLES; e->y1 *= NSVG__SUBSAMPLES; } // Rasterize edges nsvg_qsort(r->edges, r->nedges, sizeof(NSVGedge), NULL); // now, traverse the scanlines and find the intersections on each scanline, use non-zero rule nsvg__initPaint(&cache, &shape->fill, shape, xform); nsvg__rasterizeSortedEdges(r, &cache, shape->fillRule, &shape->clip); } if (shape->stroke.type != NSVG_PAINT_NONE && (shape->strokeWidth * min_scale) > 0.01f) { nsvg__resetPool(r); r->freelist = NULL; r->nedges = 0; nsvg__flattenShapeStroke(r, shape, xform); // Scale and translate edges for (int i = 0; i < r->nedges; i++) { e = &r->edges[i]; e->y0 *= NSVG__SUBSAMPLES; e->y1 *= NSVG__SUBSAMPLES; } // Rasterize edges nsvg_qsort(r->edges, r->nedges, sizeof(NSVGedge), NULL); // now, traverse the scanlines and find the intersections on each scanline, use non-zero rule nsvg__initPaint(&cache, &shape->stroke, shape, xform); nsvg__rasterizeSortedEdges(r, &cache, NSVG_FILLRULE_NONZERO, &shape->clip); } } void nsvg__rasterizeClipPaths( NSVGrasterizer* r, NSVGimage* image, int w, int h, float tx, float ty, float scalex, float scaley) { int clipPathCount = 0; NSVGclipPath* clipPath = image->clipPaths; if (clipPath == NULL) { r->stencil = NULL; return; } while (clipPath != NULL) { clipPathCount++; clipPath = clipPath->next; } UINTN oldSize = r->stencilSize * clipPathCount; r->stencilStride = w / 8 + (w % 8 != 0 ? 1 : 0); r->stencilSize = h * r->stencilStride; if (oldSize == 0) { r->stencil = (unsigned char*)AllocateZeroPool(r->stencilSize * clipPathCount); if (r->stencil == NULL) return; } else { r->stencil = (unsigned char*)ReallocatePool(oldSize, r->stencilSize * clipPathCount, r->stencil); if (r->stencil == NULL) return; SetMem(r->stencil, r->stencilSize * clipPathCount, 0); } clipPath = image->clipPaths; while (clipPath != NULL) { nsvg__rasterizeShapes(r, clipPath->shapes, NULL, tx, ty, scalex, scaley, &r->stencil[r->stencilSize * clipPath->index], w, h, r->stencilStride, nsvg__scanlineBit); clipPath = clipPath->next; } } void nsvgRasterize(NSVGrasterizer* r, NSVGimage* image, float tx, float ty, float scalex, float scaley, UINT8* dst, int w, int h, int stride) { nsvgRasterize(r, image, &image->realBounds[0], NULL, tx, ty, scalex, scaley, dst, w, h, stride); } void nsvgRasterize(NSVGrasterizer* r, NSVGimage* image, float* bounds, const char* groupName, float tx, float ty, float scalex, float scaley, UINT8* dst, int w, int h, int stride) { tx -= bounds[0] * scalex; ty -= bounds[1] * scaley; // DBG(" image %s will be scaled by [%f]\n", image->id, scalex); // nsvg__dumpFloat(" image real bounds ", image->realBounds, 4); nsvg__rasterizeClipPaths(r, image, w, h, tx, ty, scalex, scaley); nsvg__rasterizeShapes(r, image->shapes, groupName, tx, ty, scalex, scaley, dst, w, h, stride, nsvg__scanlineSolid); nsvg__unpremultiplyAlpha(dst, w, h, stride); }