PointToLineDistance.cpp

/**
 * @brief Get distance from a point to line
 *
 * @param p0 The point
 * @param p1 Starting point of line
 * @param p2 End point of line
 *
 * @return distance*distance
 */
float pointLineDistance(const glm::vec2 &p0, const glm::vec2 &p1, const glm::vec2 &p2)
{
    return 
        ( (p2.y - p1.y) * p0.x - (p2.x-p1.x)*p0.y + p2.x*p1.y - p2.y*p1.x) *
        ( (p2.y - p1.y) * p0.x - (p2.x-p1.x)*p0.y + p2.x*p1.y - p2.y*p1.x) /
        ((p2.y - p1.y) * (p2.y - p1.y)  + (p2.x-p1.x)*(p2.x-p1.x));
}