[编程交流] Osnap交点

[color=GREEN];; 2-Arc Intersection  -  Lee Mac[/color]
[color=GREEN];; Returns the point(s) of intersection between two arcs[/color]
[color=GREEN];; with centres c1,c2 radii r1,r2, start angles s1,s2 & end angles e1,e2[/color]
([color=BLUE]defun[/color] LM:arc-arc-inters ( c1 r1 s1 e1 c2 r2 s2 e2 )
   ([color=BLUE]cond[/color]
       (   ([color=BLUE]<[/color] e1 s1) (LM:arc-arc-inters c1 r1 s1 ([color=BLUE]+[/color] e1 [color=BLUE]pi[/color] [color=BLUE]pi[/color]) c2 r2 s2 e2))
       (   ([color=BLUE]<[/color] e2 s2) (LM:arc-arc-inters c1 r1 s1 e1 c2 r2 s2 ([color=BLUE]+[/color] e2 [color=BLUE]pi[/color] [color=BLUE]pi[/color])))
       (   ([color=BLUE]vl-remove-if-not[/color]
              '([color=BLUE]lambda[/color] ( pt ) ([color=BLUE]and[/color] ([color=BLUE]<=[/color] s1 ([color=BLUE]angle[/color] c1 pt) e1) ([color=BLUE]<=[/color] s2 ([color=BLUE]angle[/color] c2 pt) e2)))
               (LM:circle-circle-inters c1 r1 c2 r2)
           )
       )
   )
)
[color=GREEN];; 2-Circle Intersection  -  Lee Mac[/color]
[color=GREEN];; Returns the point(s) of intersection between two circles[/color]
[color=GREEN];; with centres c1,c2 and radii r1,r2[/color]
([color=BLUE]defun[/color] LM:circle-circle-inters ( c1 r1 c2 r2 [color=BLUE]/[/color] a d m l x y )
   ([color=BLUE]if[/color] ([color=BLUE]and[/color] ([color=BLUE]<=[/color] ([color=BLUE]setq[/color] d ([color=BLUE]distance[/color] c1 c2)) ([color=BLUE]+[/color] r1 r2))
            ([color=BLUE]<=[/color] ([color=BLUE]abs[/color] ([color=BLUE]-[/color] r1 r2)) d)
       )
       ([color=BLUE]progn[/color]
           ([color=BLUE]if[/color] ([color=BLUE]equal[/color] r1 ([color=BLUE]setq[/color] x ([color=BLUE]/[/color] ([color=BLUE]-[/color] ([color=BLUE]+[/color] ([color=BLUE]*[/color] r1 r1) ([color=BLUE]*[/color] d d)) ([color=BLUE]*[/color] r2 r2)) ([color=BLUE]+[/color] d d))) 1e-
               ([color=BLUE]setq[/color]  l  ([color=BLUE]list[/color] ([color=BLUE]list[/color] x 0.0 0.0)))
               ([color=BLUE]setq[/color]  y  ([color=BLUE]sqrt[/color] ([color=BLUE]-[/color] ([color=BLUE]*[/color] r1 r1) ([color=BLUE]*[/color] x x)))
                      l  ([color=BLUE]list[/color] ([color=BLUE]list[/color] x y 0.0) ([color=BLUE]list[/color] x ([color=BLUE]-[/color] y) 0.0))
               )
           )
           ([color=BLUE]setq[/color] a ([color=BLUE]angle[/color] c1 c2)
                 m ([color=BLUE]list[/color] ([color=BLUE]list[/color] ([color=BLUE]cos[/color] a) ([color=BLUE]-[/color] ([color=BLUE]sin[/color] a)) 0) ([color=BLUE]list[/color] ([color=BLUE]sin[/color] a) ([color=BLUE]cos[/color] a) 0) '(0 0 1))
           )
           ([color=BLUE]mapcar[/color] '([color=BLUE]lambda[/color] ( v ) ([color=BLUE]mapcar[/color] '[color=BLUE]+[/color] c1 (mxv m v))) l)
       )
   )
)
[color=GREEN];; Matrix x Vector  -  Vladimir Nesterovsky[/color]
[color=GREEN];; Args: m - nxn matrix, v - vector in R^n[/color]
([color=BLUE]defun[/color] mxv ( m v )
   ([color=BLUE]mapcar[/color] '([color=BLUE]lambda[/color] ( r ) ([color=BLUE]apply[/color] '[color=BLUE]+[/color] ([color=BLUE]mapcar[/color] '[color=BLUE]*[/color] r v))) m)
)