Function axis_cost

cadquery/occ_impl/solver.py:362–397

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

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

    val = pi 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()))

    d1, d2 = (Rotate(m1_dm, R1_0 + R1), Rotate(m2_dm, R2_0 + R2))

    if val == 0:
        dummy = d1 - d2

        return ca.sumsqr(dummy)

    elif val == pi:
        dummy = d1 + d2

        return ca.sumsqr(dummy)

    dummy = ca.dot(d1, d2) - ca.cos(val)

    return dummy ** 2


def point_in_plane_cost(