diff --git a/olcUTIL_Geometry2D.h b/olcUTIL_Geometry2D.h index 0482473..185c62c 100644 --- a/olcUTIL_Geometry2D.h +++ b/olcUTIL_Geometry2D.h @@ -887,8 +887,9 @@ namespace olc::utils::geom2d template inline olc::v_2d closest(const ray& r, const olc::v_2d& p) { - // TODO: implement - return p; + auto normal = r.direction.norm(); + auto dot = normal.dot(p - r.origin); + return r.origin + normal * dot; }