work/gpstroke/pcb_draw.c

   1 #include <stdlib.h>
   2 #include <math.h>
   3 #include "pcb_draw.h"
   4 #include "c24lib/image/image.h"
   5
   6 static void draw_thick_line(image_t * dst, int x1, int y1, int x2, int y2, double vx, double vy, double nx, double ny, int th)
   7 {
   8         double x, y, ymin, ymax;
   9
  10         if (y1 <= y2) {
  11                 ymin = y1;
  12                 ymax = y2;
  13         }
  14         else {
  15                 ymin = y2;
  16                 ymax = y1;
  17         }
  18
  19         x = x1;
  20         y = y1;
  21         draw_pcb_fillcr(dst, x1, y1, th/2);
  22         for(;;) {
  23                 int n;
  24                 double xx, yy;
  25                 xx = x - nx * th / 2.0;
  26                 yy = y - ny * th / 2.0;
  27                 for(n = 0; n <= th; n++) {
  28                         if ((xx >= 0) && (xx <= dst->sx) && (yy >= 0) && (yy <= dst->sy)) {
  29                                 pixel_t *pixel = (dst->pixmap) + (int) xx + dst->sx * (int) yy;
  30                                 *pixel = pixel_black;
  31                         }
  32                         xx += nx;
  33                         yy += ny;
  34                 }
  35
  36                 x += vx/2.0;
  37                 y += vy/2.0;
  38                 if (x > x2)
  39                         break;
  40                 if ((y > ymax) || (y < ymin))
  41                         break;
  42         }
  43
  44         draw_pcb_fillcr(dst, x, y, th/2);
  45
  46         return;
  47 }
  48
  49
  50 void draw_pcb_line(image_t *dst, int x1, int y1, int x2, int y2, double th)
  51 {
  52         double nx, ny, vx, vy;
  53         double l;
  54         int tmp;
  55
  56         if (x1 > x2) {
  57                 tmp = x1;
  58                 x1 = x2;
  59                 x2 = tmp;
  60                 tmp = y1;
  61                 y1 = y2;
  62                 y2 = tmp;
  63         }
  64
  65         vx = x2 - x1;
  66         vy = y2 - y1;
  67         l = hypot(vx, vy);
  68         vx /= l;
  69         vy /= l;
  70         nx = -vy;
  71         ny = vx;
  72
  73         if ((x1 != x2) || (y1 != y2))
  74                 draw_thick_line(dst, x1, y1, x2, y2, vx, vy, nx, ny, th);
  75         else
  76                 draw_pcb_fillcr(dst, x1, y1, th/2);
  77
  78 //      draw_color(pixel_red);
  79 //      draw_line(dst, x1+nx*th/2.0, y1+ny*th, x2+nx*th, y2+ny*th/2.0);
  80 //      draw_line(dst, x1-nx*th/2.0, y1-ny*th, x2-nx*th, y2-ny*th/2.0);
  81 }
  82
  83 int *fc_pat[1000];
  84
  85 static void fc_pat_gen(int r)
  86 {
  87         int y, *p;
  88         p = fc_pat[r] = malloc(sizeof(int) * (r+1));
  89         for(y = 0; y <= r; y++) {
  90                 double x = (double)r * cos(asin((double)y/(double)r));
  91                 p[y] = round(x);
  92         }
  93 }
  94
  95 void draw_pcb_fillcr(image_t *dst, int xc, int yc, int r)
  96 {
  97         int y, x, *pa;
  98         pixel_t *p;
  99
 100         if (fc_pat[r] == NULL)
 101                 fc_pat_gen(r);
 102
 103         pa = fc_pat[r];
 104
 105         for(y = -r; y <= r; y++) {
 106                 int x1, x2, ay;
 107                 if (y+yc < 0)
 108                         continue;
 109                 if (y+yc >= dst->sy)
 110                         break;
 111                 ay = y < 0 ? -y : y;
 112                 x1 = xc - pa[ay];
 113                 x2 = xc + pa[ay];
 114                 if (x1 >= dst->sx)
 115                         continue;
 116                 if (x1 < 0)
 117                         x1 = 0;
 118                 if (x2 >= dst->sx)
 119                         x2 = dst->sx-1;
 120                 p = &image_pix(dst, x1, y+yc);
 121                 for(x = x1; x <= x2; x++,p++) {
 122                         *p = pixel_black;
 123                 }
 124         }
 125 /*      p = &image_pix(dst, xc, yc);
 126         *p = pixel_red;*/
 127 }
 128