Function point_cost

cadquery/occ_impl/solver.py:331–359

(
    problem,
    m1: gp_Pnt,
    m2: gp_Pnt,
    T1_0,
    R1_0,
    T2_0,
    R2_0,
    T1,
    R1,
    T2,
    R2,
    val: Optional[float] = None,
    scale: float = 1,
)

def point_cost(
    problem,
    m1: gp_Pnt,
    m2: gp_Pnt,
    T1_0,
    R1_0,
    T2_0,
    R2_0,
    T1,
    R1,
    T2,
    R2,
    val: Optional[float] = None,
    scale: float = 1,
) -> float:

    val = 0 if val is None else val

    m1_dm = ca.DM((m1.X(), m1.Y(), m1.Z()))
    m2_dm = ca.DM((m2.X(), m2.Y(), m2.Z()))

    dummy = (
        Transform(m1_dm, T1_0 + T1, R1_0 + R1) - Transform(m2_dm, T2_0 + T2, R2_0 + R2)
    ) / scale

    if val == 0:
        return ca.sumsqr(dummy)

    return (ca.sumsqr(dummy) - (val / scale) ** 2) ** 2


def axis_cost(