; Generated by scripts/worm_farm_sources.ts from the chapter models.
(define-component worm-link
  ((number joint-clearance 0.6mm)
   (number joint-yaw-limit 35deg)
   (number joint-pitch-limit 20deg)
   (toggle has-socket true)
   (toggle has-ball true))
  (let* ((ball-radius 4mm)
         (joint-height 5mm)
         (socket-wall 2mm)
         (cavity-radius (+ ball-radius joint-clearance))
         (socket-outer-radius (+ cavity-radius socket-wall))
         (socket-height 12mm)
         (socket-throat-radius 3mm)
         (socket-top-lever (- socket-height joint-height))
         (body-relief-radius (+ joint-clearance
           (* socket-outer-radius (cos (deg->rad joint-pitch-limit)))
           (* socket-top-lever (sin (deg->rad joint-pitch-limit)))))
         (ball-offset 11mm)
         (socket-offset -12mm)
         (neck-start 1.2mm)
         (neck-length (- ball-offset neck-start))
         (neck-width 4.8mm)
         (neck-height 2.8mm)
         (window-bottom 1.6mm)
         (window-top (- socket-height window-bottom))
         (window-height (- window-top window-bottom))
         (window-center (/ (+ window-top window-bottom) 2))
         (window-corner-radius 1mm)
         (neck-motion-clearance 1.2mm)
         (passage-half-width (+ (/ neck-width 2) neck-motion-clearance))
         (ball-bed-pedestal-radius 1.4mm)
         (ball-bed-pedestal-height 1.3mm)
         (ball-bed-flat-height 0.6mm)
         (pedestal-motion-clearance 0.3mm)
         (bottom-throat-radius (+ pedestal-motion-clearance
           (* ball-bed-pedestal-radius (cos (deg->rad joint-pitch-limit)))
           (* joint-height (sin (deg->rad joint-pitch-limit)))))
         (cutter-length 16mm))
    (build
      (shape rounded-body
        (clip-plane
          (translate 0 0 4.8mm (scale 1.15 1.12 1 (sphere 7.2mm)))
          :origin '(0 0 0) :normal '(0 0 1) :keep "positive"))
      (shape body-with-joint-relief
        (if has-ball
          (difference rounded-body
            (translate ball-offset 0 -1mm (cylinder body-relief-radius 16mm)))
          rounded-body))
      (shape socket-housing
        (if has-socket
          (union body-with-joint-relief
            (translate socket-offset 0 0 (cylinder socket-outer-radius socket-height)))
          body-with-joint-relief))
      (shape socket-cavity
        (union
          (translate socket-offset 0 joint-height (sphere cavity-radius))
          (translate socket-offset 0 joint-height
            (cylinder socket-throat-radius socket-height))
          (translate socket-offset 0 -1mm
            (cylinder bottom-throat-radius (+ window-bottom 1mm)))))
      (shape neck-passage-base
        (translate (- cutter-length) 0 window-center
          (rotate 90deg 0 90deg
            (extrude
              (rounded-rect (* passage-half-width 2) window-height window-corner-radius)
              cutter-length))))
      (shape neck-motion-envelope
        (translate socket-offset 0 0
          (apply union
            (map (lambda (yaw) (rotate 0 0 yaw neck-passage-base))
              (linspace (- joint-yaw-limit) joint-yaw-limit 7)))))
      (shape captive-socket
        (if has-socket
          (difference socket-housing socket-cavity neck-motion-envelope)
          socket-housing))
      (shape grounded-ball
        (union
          (clip-plane
            (translate ball-offset 0 joint-height (sphere ball-radius))
            :origin (list 0 0 ball-bed-flat-height) :normal '(0 0 1) :keep "positive")
          (translate ball-offset 0 0
            (cylinder ball-bed-pedestal-radius ball-bed-pedestal-height))))
      (shape central-neck-bridge
        (translate neck-start 0 window-center
          (rotate 90deg 0 90deg
            (extrude (slot-overall neck-width neck-height) neck-length))))
      (result
        (if has-ball
          (union captive-socket central-neck-bridge grounded-ball)
          captive-socket)))))

(model
  (meta :title "Two captive worm links")
  (params
    (number joint-clearance 0.6mm :label "Joint clearance" :min 0.4 :max 0.8 :step 0.05))
  (part ball-link (worm-link :joint-clearance joint-clearance :has-socket false))
  (part socket-link (translate 23mm 0 0 (worm-link :joint-clearance joint-clearance :has-ball false)))
  (verify (tag two-moving-links) (metric pieces (stl connected-component-count)) (expect pieces (= 2))))