3 function vecdiff2d(a,b) = [b[0]-a[0], b[1]-a[1]];
4 function vecdiff(a,b) = [b[0]-a[0], b[1]-a[1], b[2]-a[2]];
6 #define dsq(i) (a[i]-b[i])*(a[i]-b[i])
7 function dist2d(a,b) = sqrt(dsq(0) + dsq(1));
8 function dist(a,b) = sqrt(dsq(0) + dsq(1) + dsq(2));
11 #define vsq(i) (v[i]*v[i])
12 function vectorlen2d(v) = sqrt(vsq(0) + vsq(1));
13 function vectorlen(v) = sqrt(vsq(0) + vsq(1) + vsq(2));
16 function unitvector2d(v) = v / vectorlen2d(v);
17 function unitvector(v) = v / vectorlen(v);
19 // | m[0][0] m[0][1] |
20 // | m[1][0] m[1][1] |
21 function determinant2(m) = (m[0][0] * m[1][1] - m[0][1] * m[1][0]);
23 function clockwise2d(v) = [v[1], -v[0]];
25 // intersection of lines p1..p2 and p3..p4
26 function line_intersection_2d(p1,p2,p3,p4) = [
27 // from https://en.wikipedia.org/wiki/Line%E2%80%93line_intersection#Given_two_points_on_each_line
28 #define XY12 determinant2([p1,p2])
29 #define XY34 determinant2([p3,p4])
30 #define XU12 QU(0,1,2)
31 #define XU34 QU(0,3,4)
32 #define YU12 QU(1,1,2)
33 #define YU34 QU(1,3,4)
34 #define QU(c,i,j) determinant2([[ p##i[c], 1 ], \
37 determinant2([[ XU12, YU12 ], \
40 determinant2([[ XY12, XU12 ],
41 [ XY34, XU34 ]]) / DENOM,
42 determinant2([[ XY12, YU12 ],
43 [ XY34, YU34 ]]) / DENOM,
55 function circle_point(c, r, alpha) = [ c[0] + r * cos(alpha),
56 c[1] + r * sin(alpha) ];
58 #define d (dist2d(a,c))
59 #define alpha (atan2(a[1]-c[1],a[0]-c[0]))
60 #define gamma (asin(r / d))
61 #define beta (alpha + 90 - gamma)
63 function tangent_intersect_beta(c,r,a) =
66 function tangent_intersect_b(c,r,a) =
67 circle_point(c, r, beta);
73 function tangents_intersect_beta(cbig,rbig,csmall,rsmall) =
74 tangent_intersect_beta(cbig,rbig-rsmall,csmall);
76 function reflect_in_y(p) = [-p[0], p[1]];
78 function angle_map_range(in,base) =
79 in < base ? in + 360 :
80 in >= base + 360 ? in - 360 :