Function point_in_plane_cost

cadquery/occ_impl/solver.py:400–435

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

def point_in_plane_cost(
    problem,
    m1: gp_Pnt,
    m2: gp_Pln,
    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_dir = m2.Axis().Direction()
    m2_pnt = m2.Axis().Location().Translated(val * gp_Vec(m2_dir))

    m2_dir_dm = ca.DM((m2_dir.X(), m2_dir.Y(), m2_dir.Z()))
    m2_pnt_dm = ca.DM((m2_pnt.X(), m2_pnt.Y(), m2_pnt.Z()))

    dummy = (
        ca.dot(
            Rotate(m2_dir_dm, R2_0 + R2),
            Transform(m2_pnt_dm, T2_0 + T2, R2_0 + R2)
            - Transform(m1_dm, T1_0 + T1, R1_0 + R1),
        )
        / scale
    )

    return dummy ** 2


def point_on_line_cost(